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As  more  satellites  are  launched  into  space (  a  great 
need  exists  for  a  rapid,  recursive  (reducing  computer 
memory  requirements)  orbit  determination  method.  This 
paper  presents  such  a  method  by  applying  Kalman  Filter 
theory  to  determine  the  position  and  velocity  of  near- 
earth  satellites  using  data  from  a  fixed  observer  on  the 
Earth. 

The  vehicle  equations  of  motion  are  linearized  in  a 

Taylor  Series  expansion.  The  nominal  states,  position 

* 

and  velocity,  are  determined  by  integrating  the  nonlinear 
equations  of  motion,  and  the  linear  filter  theory  is 
used  to  estimate  the  errors  in  these  states.  The 
linear  estimated  errors  are  added  to  the  nominal  states 
to  obtain  an  updated  trajectory  which  is  used  as  the 
starting  point  on  a  new  nominal  for  the  next  integration. 

'  Actual  tracking  data  from  four  different  satellites 
are  used  in  the  study.  Convergence  of  the  error  estimates 
to  values  less  than  0.1  per  cent  of  the  best  estimates  of 
position  and  velocity  is  obtained  within  50-250  seconds 
from  the  time  of  the  initial  radar  contact.  The  program 
is  capable  of  integrating  for  over  80  seconds  with  no 
tendency  to  diverge.  Several  orbital  elements  are  com¬ 
puted,  and  these  compare  quite  closely  with  results 
supplied  by  the  Space  Detection  and  Tracking  System. 

The  rate  of  convergence  is  related  to  the  initial  guess 
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of  the  error  covariance  matrix,  along  with  the  measure¬ 
ment  accuracy  of  the  tracking  stations. 

The  paper  includes  the  Kalman  Filter  equations  along 
with  the  iterative  procedure  needed  to  process  the  filter. 
This  is  followed  by  an  explanation  of  the  coordinate 
systems,  the  formulation  of  the  dynamic  equations  of 
motion,  and  the  computer  algorithm  used.  Results  are 
presented  in  both  tabular  and  graphical  form. 
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APPLICATION  OF  THE  KALMAN  FILTER 
TO  ORBIT  DETERMINATION 

I •  Introduction 

The  job  of  quickly  and  accurately  determining  the 
orbit  of  near-earth  satellites  is  rapidly  becoming  a 
major  problem  as  more  and  more  objects  are  launched  into 
space.  One  of  the  agencies  assigned  such  a  task  is 
the  Space  Detection  and  Tracking  System  (SPADATS), 
located  at  Ent  Air  Force  Base  in  Colorado  Springs, 
Colorado.  Each  day  they  are  faced  with  the  task  of 
locating,  tracking,  and  cataloging  several  thousand 
objects  orbiting  the  Earth. 

In  order  to  determine  the  orbital  path  of  a  vehicle, 
it  is  first  necessary  to  accurately  determine  both  the 
vehicle's  position  and  velocity.  However,  since  these 
quantities  are  not  directly  observable,  it  is  necessary 
to  infer  them  from  a  sequence  of  observations  obtained 
from  radar  or  photographic  tracking  devices.  Once  the 
position  and  velocity  are  known,  they  can  be  used  to 
calculate  the  desired  orbital  elements.  Normally  six 
elements  are  required  to  precisely  describe  the  orbit 
dimension,  the  orientation  of  the  vehicle's  path  with 
respect  to  the  Earth,  and  to  locate  the  vehicle  along 
that  path  at  any  given  time. 

In  conventional  orbit  determination  methods,  it  is 
first  necessary  to  obtain  a  preliminary  orbit.  Sometimes 
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this  can  be  determined  directly  from  the  nominal  conditions 
computed  prior  to  launch  f  but  often  it  must  be  found  from 
approximate  procedures  based  upon  actual  radar  observa¬ 
tions  made  after  launch*  Several  current  techniques 
include  the  Lagrange-Gauss-Gibbs  First  Approximation* 
the  Laplacian  First  Approximation*  and  the  Herrick-Gibbs 
method.  These  methods  along  with  several  others  are 
discussed  by  Baker  in  Ref  3i 23-77. 

Once  the  preliminary  orbit  is  found*  it  is  then 
continually  updated  or  corrected  by  using  differential 
correction  techniques.  The  first  step  in  this  correction 
procedure  involves  the  "representation"  or  calculation 
of  the  available  observations  using  the  adopted  orbital 
elements.  The  representation  may  be  carried  out  by 
either  numerical  integration  (special  perturbations)  or 
analytical  integration  (general  perturbations).  The 
representation  ends  with  the  calculation  of  residuals i 
i.e.,  differences  between  the  actual  observations  and 

i 

those  computed  with  the  adopted  elements.  The  differential 
correction  theory  then  relates  these  residuals  to  improve¬ 
ments  to  the  initial  orbital  elements  by  linear  differen¬ 
tial  relationships.  The  residuals  also  give  an  indica¬ 
tion  of  the  accuracy  of  the  elements  and  aid  in  deciding 
whether  or  not  another  correction  is  necessary  (Ref  9il25). 
The  overall  purpose  of  the  differential  correction  process 
is  to  define  the  orbital  parameters  so  that  the  residuals 
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are  minimized*  Such  a  minimization  is  usually  taken  in 
the  least-squares  sense  in  that  the  parameters  are 
adjusted  until  the  sum  of  the  squares  of  the  residuals 
is  a  minimum  (Ref  3*  79-80). 

Since  the  equations  of  motion  are  highly  nonlinear, 
the  region  of  linearity  required  for  the  differential 
correction  method  becomes  more  and  more  constrictive 
about  the  nominal  trajectory  the  longer  the  time  period 
over  which  the  prediction  is  made.  Thus,  the  differen¬ 
tial  correction  technique,  by  fitting  data  over  a  long 
time  arc,  often  produces  a  result  which  is  outside  the 
linear  range.  This  produces  problems  in  convergence  and 
consumes  machine  time  (Ref  5<4-5). 

Since  the  Kalman  Filter  is  an  optimal  filter 
applicable  to  noisy,  time-varying,  linear  systems,  it 
is  particularly  suited  for  orbit  determination  problems 
in  which  estimates  of  the  state  variables  are  desired 
as  rapidly  as  possible.  At  each  data  computation  cycle 
the  filter  requires  only  the  present  state  of  the  system, 
the  present  measurement,  and  the  associated  covariance 
matrices.  The  present  estimate  of  the  state  variable 
deviation  is  related  to  the  present  actual  deviations 
in  the  observations.  This  permits  a  complete  optimal 
estimate  of  the  orbit  variables  and  the  observation 
errors  from  each  single  observation.  As  a  result, 
computational  efficiency  is  achieved  by  requiring  only 
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the  data  points  that  have  been  computed  at  the  last  cycle. 

The  differential-  correction  method  utilizes  a  large 
number  of  independent  data  in  an  after-the-fact  manner 
to  improve  orbital  parameters.  However ,  the  Kalman 
Filter  method  not  only  provides  a  recursive  procedure 
to  process  each  observation  as  it  occurst  but  also 
yields  a  predicted  set  of  orbital  parameters  coupled 
with  a  matrix  of  coefficients  uhich  depicts  the  accumu¬ 
lated  error  in  the  predictions  in  real  time.  This 
recursive  procedure  may  be  used  for  the  followingi 
(1)  satellite  or  ICBH  interception,  (2)  to  obtain  know¬ 
ledge  of  current  errors  in  prediction.  It  should  also 
be  pointed  out  that  the  Kalman  Filter  method  is  equally 
applicable  to  orbit  determination  for  either  an  orbital 
observer  or  a  fixed  observer  with  only  slight  modification 
(Ref  15.67-75). 

Statement  of  the  Problem 

The  problem  to  be  considered  involves  the  orbit 
determination  of  a  space  vehicle  by  the  application  of 
the  Kalman  Filter.  The  required  input  data  consists  of 
a  series  of  radar  observations  of  the  vehicle  from  a 
tracking  station  on  the  earth,  along  with  the  actual 
location  of  the  station.  These  radar  observations 
include  range,  range  rate,  azimuth,  elevation,  azimuth 
rate,  and  elevation  rate.  The  main  objective  of  the 
problem  is  to  determine  the  position  and  velocity  of 
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the  space  vehicle  by  using  Kalman  Filter  techniques  and 
the  data  provided  from  the  observation  point  on  the  earth. 
Then  by  using  these  results  several  orbital  elements 
can  be  calculated  such  as  the  semi-major  axis,  eccentri¬ 
city.  and  inclination  angle. 

Assumptions  and  Limitations 

The  equations  of  motion  of  the  vehicle  are  derived  ■ 

•  t 

using  the  assumption  that  the  vehicle  has  negligible 

.  C  *  / 

mass  and  is  under  the  gravitational  action  of  a  single 
dominant  central  force  field,  the  earth.  The  perturba¬ 
tions  due  to  the  earth's  oblateness  are  included  in  the 
program,  but  other  external  perturbations  and  system 
disturbances,  such  as  atmospheric  and  solar  drag,  are 

assumed  negligible.  Also,  only  the  motion  of  non- thrusting 

/  \ 

satellites  are  considered,  and  any  uncertainties  in  the 
latitude,  longitude,  or  height  of  the  tracking  stations 
are  considered  negligible. 

Plan  of  Development  * 

Thi  s  report  is  divided  into  six  chapters  plus  an 
Appendix.  Chapter  11  presents  the  Kalman  Filter  equa- 
tions  and  describes  the  basic  iterative  procedure  needed 
to  implement  these  equations.  This  is  followed  in 
Chapter  111  by  an  explanation  of  the  coordinate  systems 
used,  the  formulation  of  the  dynamic  equations  of  motion 
for  an  orbiting  space  vehicle,  and  the  linearization 
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procedure.  Chapter  IV  describes  the  basic  orbit  deter¬ 
mination  algorithm  along  with  the  comjmter  program  used 

* 

to  implement  it.  Chapter  V  presents  and  analyzes  the 
results  obtained,  and  conclusions  and  recommendations 
are  given  in  Chapter  VI.  The  initial  nominal  trajectory 
equations,  the  derivation  of  the  system  description 
matrix,  the  initial  trajectory  equations,  a  listing  of 
the  computer  program,  and  additional  graphical  results 
&  are  included,  in  the  Appendixes. 
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II.  The  Kalman  Filter  Equations 


Linear  System 

The  Kalman  Filter  is  a  recursive  data  processing 
technique.  It  utilizes  the  measurement  covariance 
matrix,  the  state  covariance  matrix,  a  dynamic  vehicle 
model,  and  the  model  noise  statistics,  to  provide  a 
minimum-variance  estimate  of  the  state  variables  in  a 
nonstationary  linear  system.  The  basic  Kalman  Filter 
equations  are  presented  in  this  chapter,  vhile  an  actual 
derivation  can  be  found  in  Ref  61 125-128. 

The  covariance  matrix  for  two  random  processes  is 
defined  in  terms  of  the  ensemble  average  values  of  the 
vectors  and  the  ensemble  average  value  of  their  outer 
product.  The  covariance  matrix  for  a(t)  and  b(t)  is 
given  by  (E  denotes  ensemble  expectation) 

cov[a(t),b(t)]  **  E[a(t)bT(t)]  -  E[a(t)]  E[bT(t)]  (l) 

Since  only  zero  mean  quantities  are  dealt  with  in  Kalman 
Filter  work,  the  simplification 

cov[a(t),b(t)]  a  E[a(t)bT(t)]  (2) 

can  be  made.  The  covariance  of  the  errors  in  the  Kalman 
Filter  estimate  of  the  state  x  is  described  by  the  matrix  P 


P(t)  =  covfx(t),x(t)l 
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For  measurement  noises,  the  covariance  is  given  by 


R  =  cov(v,v) 


When  the  discrete  version  of  the  Kalman  Filter  is  used, 
the  requirement  that  the  measurement  noise  and  system 
disturbances  be  uncorrelated  over  the  smallest  measure¬ 
ment  interval  gives  the  restrictions 


covCVjjjjVjj)  =  0  for  m  £  n 


covtem»Xn)  “  ^  for  m  =  n 


Thus  the  measurement  covariance  matrix  relates  the  state 
variables  to  the  quantities  being  measured,  while  the 
state  covariance  matrix  describes  the  uncertainty  in  the 
optic:  t  estimate  of  the  state  vector.  The  diagonal  terms 
of  the  state  covariance  matrix  are  the  variances  in  the 
estimation  error  for  each  of  the  individual  state  variables. 
The  off-diagonal  terms  are  a  measure  of  the  cross-correla¬ 
tion  between  the  state  variables. 

The  state  variables  of  a  linear  system  are  written 
in  the  form  of  a  state  vector 


The  vector  notation  permits  the  linear  system  to  be 
described  by  the  unforced  matrix  differential  equation 


« 

•*  i 


/ 
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x  =  Fx  (8) 

where  F  is  the  system  description  matrix.  The  measurements 
in  the  Kalman  Filter  are  taken  as  linear  combinations  of 
the  system  state  variables,  corrupted  by  uncorrelated 
noise.  The  measurement  equation  is  written  as 

z  =  Mx  +  v  (9) 

where  z  is  the  set  of  measurements  arranged  in  vector  form, 
M  is  the  measurement  matrix  which  describes  the  linear 
combination  of  state  variables  which  comprise  z  in  the 
absence  of  noise,  and  v  is  a  vector  of  random  noise 
quantities  corrupting  the  measurements. 

One  way  to  use  the  measurement  vector  z  is  to  antici¬ 
pate  it  based  on  knowledge  of  the  measurement  matrix  Mn 
and  the  estimate  of  the  state  vector  at  the  instant  the 
measurements  are  taken.  If  zn  and  do  not  agree, 

the  difference  must  result  from  the  measurement  noise  vn 

■  } 

or  an  error  in  the  estimate.  The  state  variable  estimates 
can  then  be  changed  according  to  statistical  knowledge  of 
the  errors  in  2^  and  of  the  measurement  errors.  Thus,  the 
state  error  vector  estimate  after  consideration  of  the 
measurement  is  given  by 

2n<+>  “  2n<->  +  Kn[Sn-MJn<->] 


(10) 
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Where  the  (-)  and  (+)  indicate  immediately  prior  to  and 
after  a  measurement  respectively.  '  The  filter  gain  matrix 

F 

is  determined  by 

Kn  -  +  R]  '*  <“> 

Between  measurements,  the  state  error  vector  estimate  is 
determined  from 


^n+l 


,,  A 
Irn 


(12) 


Where  3>,  the  state  transition  matrix*  is  computed  from 
the  system  dynamics  as  expressed  in  the  system  matrix  F. 
When  F  is  a  constant ,  is  a  function  of  the  time  differ¬ 
ence  At,  and  is  represented  by  the  series 


<J>  =  I  +  FAt  +  F2At2/2l  +  •  •  • 


(13) 


The  use  of  measurements  provided  at  discrete  instants 

.  j 

of  time  causes  the  error  covariance  to  be  discontinuous, 
having  different  values  before  and  after  the  measurements. 
The  value  prior  to  a  new  measurement  is  determined  by 

i . 

«*> 


where  <t>  is  the  state  transition  matrix  defined  in  Eq  (13). 
If  Eq  (10)  is  used  to  improve  the  state  vector 

-  *j' 

estimate,  the  new  error  covariance  is  expressed  by 

Pn(+>  =  d-V'n)pn<-XI-KnMn>T  +  W  l  <15> 


10 
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where  1  is  the  square  identity  matrix  and  Rn  is  the 
covariance  matrix  of  the  measurement  errors  vn.  This 
equation  can  be  written  in  ether  forms,  but  Eq  (15),  due 
to  its  symmetry,  is  preferred  since  it  is  less  sensitive 
to  computational  inaccuracy  (Ref  Hi 261). 

Extension  to  Non-Linear  Systems 

Since  the  Kalman  Filter  is  an  optimal  filter 
applicable  to  noisy,  time-varying,  linear  systems,  it  is 
necessary  to  linearize  the  vehicle  equations  of  motion 
in  a  Taylor  series  expansion  about  a  nominal  trajectory. 
The  nominal  states,  position  and  velocity,  are  determined 
by  Integrating  tKeS^onlinear  equations  of  motion,  and 
the  Kalman  Fil/er  theory  Ts^the^  used  to  estimate  the 

errors  in  the\pominal  states.  The  linear  filter  theory 

\  • 

is  applied  to  the  estimates  of  the  errors  in  the  states 
since  these  errors  in  a  nonlinear  system  behave  much  more 
linearly  than  the  states  themselves.  By  adding  these 
linear  estimated  errors  to  the  nominal  states,  an  updated 
trajectory  is  obtained  for  use  as  the  starting  point  on 
a  new  nominal  for  the  next  integration.  This  nominal 
estimated  trajectory  is  therefore  being  used  as  the 
reference  about  which  the  linearization  is  done.  This 
can  cause  large  estimated  errors  initially  since  the 
initial  estimated  trajectory  may  be  far  from  the  actual 
trajectory,  thereby  resulting  in  a  violation  of  the  basic 
linearity  assumptions*  As  more  measurements  are  processed 


.  - -  - - -  ,  .»-■  J-A  - 
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however,  the  recursive  action  of  the  Kalman  Filter  will 
cause  the  updated  nominal  to  approach  the  actual  trajectory; 

Many  past  applications  of  Kalman  Filtering  to  non¬ 
linear  systems  involved  linearization  about  a  pre¬ 
computed  nominal  trajectory.  This  approach  allows  fcr  the 
pre-computation  of  the  error  covariance  matrices  P(-)  and 
P(+)»  An  application  of  Kalman  Filtering  to  a  near- 
nominal  ascent  guidance  problem  is  given  by  J,  A.  Henz 
in  Ref  13.  The  problem  associated  with  a  pre-computed 
nominal  is  that  noise  either  in  the  measurements,  the 
random  system  disturbances,  or  both,  could  cause  the 
linearized  equations  to  be  totally  unsatisfactory 
approximations  to  the  true  nonlinear  equations. 

This  problem  then  becomes  the  motivation  for  the 
approach  of  continuously  expanding  about  the  latest 
optimal  estimate  of  the  nominal  trajectory.  The  reason¬ 
ing  is  that  if  the  filter  is  working  fairly  well,  the 
updated  nominal  value  should  be  much  closer  to  the 
actual  trajectory  than  the  old  nominal  value.  As  a 
result,  the  first  fwder  Taylor  series  expansions  about 
the  new  nominal  will  naturally  be  more  accurate  approxima¬ 
tions.  The  success  of  the  filter  which  results  from 
linearizing  about  the  latest  nominal  trajectory  as  it 
becomes  available  has,  in  fact,  been  so  good  that  it 
has  become  the  "work-horse"  recursive  filter  for  almost 
all  real  applications  (Ref  12i35). 


12 
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Data  Weeded  For  Kalman  Filter 

In  order  to  apply  the  Kalman  Filter ,  certain 
information  about  the  system  and  the  statistical  character¬ 
istics  of  the  input  and  measurement  noises  must  be  known 
or  assumed.  The  following  data  is  required  to  initialize 
the  Kalman  Filter  processt 

1.  System  description  matrix  F 

2.  Sampling  time  At 

3.  State  transition  matrix  <t> 

4.  Measurement  matrix  M 

5.  Measurement  noise  covariance  matrix  R 

6.  Initial  state  covariance  matrix  P(0) 

7.  Initial  state  estimate  x(0) 

The  block  diagram  for  the  discrete  Kalman  Filter  is  shown 
in  Fig.  1. 


/ 
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Fig,  1  Flow  Chart  For  Discrete  Kalman  Filter 
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III.  Equations  of  Motion 

Coordinate  Reference  Systems 

The  position  of  a  satellite  may  be  referred  to  a 
wide  variety  of  coordinate  systems.  These  systems  differ 
primarily  in  the  choice  of  origin  and  fundamental  refer¬ 
ence  plane.  Two  coordinate  origins  are  involved  in  the 
satellite  problem!  the  radar  observer  (rotating  topodetic 
system) ,  and  the  center  of  the  Earth  (geocentric  system) 
(Ref  9t7).  The  geocentric  system  is  further  divided  by 
referring  to  an  inertial  geocentric  system  and  a  rotating 
geocentric  system.  The  three  coordinate  systems  are 
shown  in  Fig.  2. 

Inertial  Geocentric  System.  The  center  of  the  earth 
is  the  origin  of  the  inertial  geocentric  system,  and  the 
principal  direction.  Xj,  is  toward  the  mean  vernal  equinox 
of  date.  The  positive  Z^-axis  is  in  the  direction  of  the 
mean  north  celestial  pole  and  the  Yj-axis  completes  a 
right-handed  orthogonal  coordinate  system.  This  is  the 
coordinate  frame  in  which  the  orbital  elements  are 
computed. 

Rotating  Geocentric  System.  The  center  of  the  earth 
is  the  origin  of  the  rotating  geocentric  system,  and  the 
principal  direction,  Xg,  is  toward  the  intersection  of 
the  prime  meridian,  Greenwich,  and  the  equator.  The 
positive  Zg-axis  is  in  the  direction  of  the  north 
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celestial  pole  and  the  Yg-axis  completes  a  right-handed 

orthogonal  system.  This  coordinate  systett  serves  as 

the  reference  for  the  equations  of  motion  of  the  satellite. 

Rotating  Topodetic  System.  The  third  coordinate 
system,  the  rotating  topodetic,  has  an  origin  at  the 

tracking  station  (topos).  The  principal  direction,  X^, 

> 

is  toward  the  local  North  direction  on  the  target  plane 
to  the  spheroid  model.  The  positive  Z^-axis  is  normal  to 
the  spheroid -model,  and  the  Y^-axis  completes  a  right- 
handed  system.  The  earth  model  used  as  the  reference 
spheroid  is  described  in  Rof  1.  Since  this  rotating 
topodetic  system  is  used  as  the  reference  frame  for  the 
observed  values  of  the  measurements,  it  is  convenient 
to  also  use  it  for  the  calculated  values. 

Initial  Nominal  Trajectory 

The  initial  nominal  trajectory  (position  and  velocity) 
is  determined  from  the  first  set  of  input  data  provided 
by  the  radar  tracking  station.  This  data  includes  the 
range/  range  rate,  azimuth,  elevation,  and  azimuth  and 
elevation  rate  of  the  satellite  being  tracked.  The 
equations  used  to  compute  the  position  and  velocity  of 
the  satellite  in  the  irotating  geocentric  system  are  given 
below,  and  the  individual  vector  components  are  presented 
in  Appendix  B. 
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f  *  PL  -  PL  (17) 

•  y 

r  .  '■  A; 

Equations  of  Motion 

. -  -  -  __  •  ‘ 

The  nonlinear  equations  for  the  vehicle  in  the  rota- 

~s, 

ting  geocentric  coordinate  system  are  given  by 

x  **  f\  »  -  ^(1+Harmonic  A)  +  lusy  +  xJ*  (18) 

,  & 

s  c 

y  a  £2  3  -  H^O+Harmonic  A)  -  2o>x  +  y«2  (19) 

z  ts  =s  -  f^(l+Harmonic  B)  (20) 

Centripetal  force  and  Coriolis  force  terms  are  included 
in  the  equations  sihee  the  accelerations  are  referenced 
to  a  rotating  frame.  The  harmonic  terms  are  given  by 

1  »/  y  '  , 

*  - 

* 

Harmonic  A  «  1  ,.5J2(Ae/r)2[l-5(z/r)2J  + 

2.5J3(Ae/r)3[3-7(z/r)2Jz/r  (21) 

s  ”  • 

Harmonic  B  «  1.5J2(Ae/r)2£3-5(z/r)2J  + 

j2.5J3(Ae/r)3[6-7(z/r)3Jz/r  -  (22) 

*  *  •.  "  r\/ 

where  J£  and  J3  are  zonal  harmonic  constants  vritich  repre¬ 
sent  the  deviation  of  the  earth  from  a  perfect  sphere.. 

All  subsequent  zonal  harmonic  terms  and  all  of  the  tesseral 
harmonic  terms  are  neglected  in  ordi|:  to  simplify  the 

Taylor  Series  expansion  of  the  nonlinear  equations  of 

1  1  * 

motion.  A  complete  discussion  of  the  equations  of  motion 
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and  the  harmonic  terms  can  be  found  in  Baker  (Refs  2il44- 
145,  3i 167-183).  Equations  (18),  (19),  and  (20)  actually 
represent  a  set  of  six  first  order  differential  equations 

i — 

or  a  6  x  1  state  vector  differential  equation,  where  the 
first  three  states  represent  position  and  the  latter 
three  velocity,  all  in  Cartesian  coordinates.  Next,  the 
non-linear  equations  of  motion  are  expanded  in  a  Taylor 
Series  about  a  nominal  trajectory! 

X  -  f!<x  ,y  ,x  ,y  ,z  )  *  — (x-x  )  ♦  ^Cy-y  )  + 

*fi,  **  ill/*  •*%  3fi,* 

- — (z-z  )  +  rv-(x-x  )  ♦  “-r-(y-y  )  + 
dz  3x  ay 


— r-(z-z  )  +  h.o.t. 
dz 


(23) 


with  similar  equations  for  y  and  z 


(24)-(25) 


Now  a  linear  state  vector  or  error  estimate  vector 
2  is  defined  as  the  difference  between  the  actual  and 
nominal  state  vector. 


X  -  X 

4 

Y  -  Y 


Z  -  Z 
• 

X-X 

• 

Y  -  Y 


(26) 


Z  -  Z 


Combining  Eqs  (23),  (24),  and  (25)  with  Eq  (26),  and 
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retaining  only  first  order  terms ,  results  in  the  linear 
state  vector  differential  equation 


❖  _A 

x  b  Fx 


where  F  is  defined  as 


and  F(t)  is  given  by 


F 


0  ,  1 


F(t) 


F(t) 


afl 

.  2£il 

3x 

• 

3y 

dz 

• 

•is 

•  •  •  • 

.  « 3 

ax 

ai 

(27) 


(28) 


(29) 


All  the  partial  derivatives  in  Eq  (29)  are  evaluated 
along  the  nominal  trajectory.  The  actual  derivation  of 
the  system  description  matrix.  F(t),  is  given  in  Appendix 
B.  Application  of  the  Kalman  Filter  provides  the  best 
estimate  of  the  linear  state  vector,  x,  which  is  then 
used  in  Eq  (10)  to  obtain  the  latest  best  estimate  of  the 
nominal  trajectory. 

i 

Coordinate  Transformation 

The  measurement  data  includes  slant  range,  slant 
range  rate,  azimuth,  and  elevation  as  shown  in  Fig,  3. 
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Because  the  calculated  coordinate  values  of  the  slant 

range  vector  are  desired  in  the  rotating  topodetic  , 

\  t 
coordinate  system,  a  transformation  is  needed  to  go  from 

.  the  rotating  geocentric  system  to  the  rotating  topodetic 

system.  Since  the  slant  range  vector  is  the  sum  of  the 

\  .  - 

geocentric  position  vector  of  the  tracking  station  and 
1  .  7 

the  geocentric  position  vector  of  the  satellite  (Fig.  2), 

then  the  coordinate  transformation  is  given  by 


-8in(0)cos(0) 

-sin(0)sin(d) 

cos(^) 

t  * 

YX 

e 

sin(d) 

-cos(d) 

0 

y+Y 

(30) 

* 

cos(0)cos(d) 

-  o 

cos(0)sin(d) 

sin(^) 

. 

z+Z 

This  is  an  orthogonal  transformation  matrix,,  Where  <f>  and 

.  '  O  „ 

0  represent  the  latitude  arid  longitude  of  the  tracking 
statipn  respectively,  and  X T,  YT,  and  ZT  are  the  topodetic 
coordinates  of  the  range  vector. 


^  o 
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The  slant  range,  slant  range  rate,  azimuth,  and 
elevation  are  calculated  using  Eqs  (31)-(34) 

C2  2  211/2 

(x+X)  +  (y+Y)  +  (z+Z)  J 

p  *=  1/p[(x+X)^  x  +  (y+Y)^  y  +  (z+Z)^  zj 

\ 

A  «  TAN"1  [^-Yt/XtJ 


■lr  . .  2  2  l^2l 

E  *  TAN  1  ZT/(P  -ZT  )  J  (3 

These  equations  are  based  on  the  geometry  of  Figs.  2-3. 
Equation  (32)  represents  only  the  radial  component  of 
the  slant  range  rate  vector,  and  is  derived  by  taking 
the  dot  product  of  the  slant  range  rate  and  slant  range 
vectors. 

The  measurements  may  be  expressed  in  the  form 

pm  -  pa  +  vl 

P»  '  P»  +  V2  (3 

*m  *  A«  +  v3 
Em  “  E«  ♦  v4 

where  the  subscripts  "aH  and  "m*  denote  the  actual  values 
and  the  measured  values  respectively,  and  v^  represents 
zero  mean,  Gaussian-distributed  white  noise* 
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Next*  define 


Apm  “  pn  ‘  pn 
-  pm  '  pn 


(36) 


uhere  the  subscripts  "nM  and  "o"  denote  the  nominal  values 
and  the  measured  values  respectively.  Now  let 


Ap  B  p 

cl 


AA  =  A^  — 


(37) 


This  allows  Eq  (35)  to  be  rewritten  as 


APm 

AP 

• 

V1 

APm 

Ap 

v2 

AA« 

tz 

AA 

+ 

v3 

i 

> 

.a" 

AE 

v4 

(38) 


The  quantities  Ap,  Ap»  A  A,  and  AE  represent  deviation?  from 
from  the  nominal,  and  if  these  are  assumed  small,  then 
a  first  order  Taylor  Series  expansion  about  the  nominal 
results  in 
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~3p 

3  P 

3P 

e 

3X 

3y 

•  •  — j- 

3z 

P 

• 

• 

m 

• 

• 

A 

• 

• 

3E 

3E 

E 

3x 

e  # 

•  “T 

3z 

x6 


(39) 


The  linear  measurement  vector ,  z,  can  now' be  defined  as 

z(t)  »  M(t)x  +  v(t)  (40) 

where  v(t)  is  the  noise  vector  and  x  is  the  linear  state 
vector  defined  by  Eq  (26).  The  measurement  matrix  M  is 
the  matrix  of  partial  derivatives  in  Eq  (39) ,  and  the 
actual,  partial s  are  derived  in  Appendix  C.  <•  The  components 
of  M  are  always  evaluated  at  the  latest  value  of  the 
nominal  trajectory.  The  validity  of  the  linear  model 
as  expressed  by  Eqs  (27)  and  (40)  is  dependent  upon  the 
nearness  of  the  nominal  trajectory  to  the  actual  trajec¬ 
tory.  If  the  estimation  error  is  too  large,  then  the 
higher-order  terms  neglected  in  the  Taylor  Series  become 
important.  Experience  has  shown  that,  in  most  cases,  the 
assumption  of  a  linear  model  is  adequate  for  near-earth 
orbits,  even  for  position  errors  approaching  two  to  five 
miles  (Ref  7tl3). 

Subopt imal  Kalman  Filter 

The  linear  state  vector  differential  equation  given 
in  Eq  (27)  is  never  solved  in  the  basic  algorithm.  Its 


o 
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derivation  is  necessary  to  produce  a  system  description 
matrix,  F,  which  is  used  to  compute  a  value  of  the  state 
transition  matrix.  Likewise,  the  linear  measurement 
vector  equation  given  in  Eq  (40)  simply  defines  the 
measurement  matrix  M,  which  is  needed  for  the  Kalman 
Filter  equations. 

In  view  of  the  definition  of  the  linear  state 
variables  g  and  z,  Eq  (10)  is  presented  again. 


L(+) 

—n 


2n<->  +  Kn[Sn  '  “«*.<*>] 


Let  x  (-)  be  the  nominal  values  of  position  and  velocity 


obtained  by  integration  of  the  nonlinear  equations  of 
motion.  These  values  are  considered  to  be  the  best 
estimates  available  just  prior  to  a  measurement. 


A  /  \  T 

2S  <-)  “  x 


The  quantity  within  the  brackets  of  Eq  (41)  actually 
represents  the  definition  of  the  linear  measurement 
vector,  because  M^x^-)  may  be  computed  from  Eqs  (31)- 
(34),  and  by  letting 


Snom  * 

— nom  n— 


then 


z  g  z  -  z 
—  — n  —nom 


Equation  (41)  can  then  be  rewritten  as 


x(+)  g  x*  +  Kz 
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By  letting  x(+)  be  the  best  estimate  of  position  and 
velocity  after  a  measurement,  then 


X(+)  a  X 

(46) 

and 

2  "  X  -  X* 

(47) 

Thus,  Eq  (45)  may  be  expressed  in  terms  of  the  linear 
error  vector  and  the  linear  measurement  vector, 


ta  K  Z 


(48) 


i^raust  be  emphasized  that  the  filter  which  is  repre¬ 
sented  in  Eq  (41)  is  not  the  exact  optimal  filter  for  the 
nonlinear  system  of  Eqs  (8)  and  (9).  Rather,  it  is  a 
first-order  approximation  which  is  valid  only  to  the 
extent  that  the  linearized  model  in  Eqs  (27)  and  (40) 
is  a  valid,  approximation  of  the  original  nonlinear  system. 
Basically,  what  has  been  done  here  is  to  use  the  linear 
theory  as  a  guide  to  obtain  an  approximate  solution  of 
a  nonlinear  filtering  problem  (Ref  8i 11-15).  A  Kalman 
Filter  used  in  this  manner  is  frequently  referred  to  as  a 
subopt imal  Kalman  Filter. 
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IV.  Program  Description 


This  section  gives  a  brief  description  of  the 
computer  program  written  to  apply  the  Kalman  Filter  to 
the  problem  of  orbit  determination.  The  program  is  run 
on  the  IBM  7094  computer  located  at  Wright  Patterson  Air 
Force  Base,  Ohio.  A  complete  listing  of  the  program, 
a  listing  of  all  the  variables  used  in  the  program,  and 

an  example  of  the  input  data  required,  is  found  in 

* 

Appendix  C. 


Computer  Algorithm 

The  following  is  the  basic  algorithm  used  to  imple- 

\ 

ment  the  Kalman  Filter  in  an  orbit  determination  problem. 

1.  Input  P,  P,  A,  E,  A,  E.  Ht,  0,  0,  P(0),  R(0) 

2.  Compute  initial  nominal  trajectory  x* (r  and  r) 

3.  Compute  orbital  elements 

4.  Calculate  estimates  of  state  errors t  x  =  Kz 

5.  Update  nominal  trajectory  2_(+)  ®  ;£-(-)  + 


6.  Update  error  covariance  matrix  from  tR  to  t^^ 

7.  Numerically  integrate  non-linear  equations  of 

motion  from  t  to  t 

n  n*ri 

8.  Check  to  see  if  new  measurement  data  is  availablei 

a.  Yes  -  Go  to  step  4 

b.  No  -  Go  to  step  6 

9.  Continue  until  all  data  has  been  processed. 

10.  Recompute  orbital  elements.  * 
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Description  of  Computer  Program 

The  computer  program  consists  of  a  MAIN  program  plus 
additional  subroutines  needed  to  implement  the  various 
steps  of  the  basic  algorithm. 

*  MAIN  Program.  The  MAIN  program  calls  the  operational 
subroutines  in  the  following  sequences 

I 

1.  Call  ZERO  to  initialize  the  various  constants 
needed  in  the  program. 

/ 

2.  Call  INPUT  to  input  range,  range  rate,  station 
height,  latitude  and  longitude  of  station, 
initial  state  error  covariance  matrix,  and 
measurement  error  covariance  matrix. 

3.  Call  STAT  to  compute  the  coordinate  transformation 

•  / 

matrix. 

4.  Call  EQCOMP  to  calculate  initial  nominal  trajec¬ 
tory  (r  and  r). 

5.  Call  ELECTS  to  compute  orbital  elements. 

6.  Update  the  nominal  trajectory  by  calling  KALMAN. 

7.  Call  UPCOV  to  update  the  error  covariance  matrix 
from  tn  to 

/ 

8.  Numerically  integrate  nonlinear  equations  of 
motion  (supplied  by  DERT)  in  TRAJ. 

9.  Check  for  new  measurement  datai 

a.  If  available,  return  to  step  6. 

b.  If  not  available,  return  to  step  7. 

I 

10.  Continue  the  above  procedure  until  all  measurement 
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data  is  processed. 

11.  Call  DRAV  to  plot  results. 

Subroutines.  A  brief  description  of  each  of  the 

subroutines  used  in  the  program  is  given  belowt 

c 

ZERO  -  Initializes  the  various  constants  needed 
'  in  the  program  ^ 

INPUT  -  Reads  in  the  following  initial  datai 
Card  1  -  Integration  step  size 
Card  2  -  Station  biases 
Card  3  -  Initial  error  covariance  matrix 
Card  4  -  Initial  measurement  covariance 
matrix 

i 

Card  5  -  Ephemeris  starting  time 
Card  6  -  Latitude,  longitude,  height  of 
station 

Card  7  -  Initial  measurements 
INPUTA  -  Reads  in  the  second  and  subsequent  radar 
observation  cards.  The  format  is  consis¬ 
tent  with  SPADATS  data  cards. 

OUTPTA  -  Lists  the  station  parameters  and  radar 

\ 

measurements  (input  data),  satellite 
position  and  velocity,  and  orbital 
elements  (output  data). 

UPCOV  -  Updates  the  error  covariance  matrix  (Eq  14) 

from  time  t_  to  t,. . 

n  n+l 

EQCOMP  -  Computes  the  equatorial  components  of 
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yrs. 

)e 

r 


position  and  velocity  for  use  as  the 

:  a  A 

initial  nominal  trajectory.  The  equations 

o 

used  are  found  in  Ref  2t  118-130,  and 
Appendix  A.  , 

ELEMTS1  -  Computes  the  orbital  elements  when  given 

’  p  \ 

the  equatorial  components  for  position 

^  . 

and  velocity.  P^  Q,  and  W  unit  vectors 

t  ■ 

•  *  i 

'  are  used  and  the  actual  equations  are 

o  \  #5- 

given  in  Ref  3l1L-22. 

I  ’  *  '  ■  -  ■:  .  / 

ELEMTS2  -  Computes  the  orbital  elements  when  given 


^  the  equatorial  coc 


>r  position 


and  velocity.  If,  V,  and  W  unit  vectors 

"• '  *  .  j 

^  "  are  used  and  the  actual  equations  are 

.  „  given  in  Ref  lOi  55-60. 

STAT  -  Computes  the  coordinate  transformation 

»  v  »  ,  > 

matrix  from  the  latitude  and  longitude  of 

,  •’  *  t 

O  i, 

the  station... 

•>  mT  " 

V 

MEAS  v  -  Computes  the  range,  range^  rate,  azimuth,  - 

|-  ,  ^  * 

and  elevation  (Eqs  31-34)  for  comparison 

with  the  measured  values  from  the  tracking 

’  A  , 

*  *  V, 

station. The  measurement  matrix  (Appendix 

v>  c 

C).  is  also  computed  for  use  in  KALMAN. 

*  , 

DERT  -  Provides  the  vehicle  equations  ^  of  motion 

*  » 

.  (Eqs  18-20)  to  be  Numerically  integrated.  — 

0 

TRAJ  -  Numerically  integrates  the  nonlinear 

°  *  r-  >  ‘ 

.  equations  of  motion  using  an  Adams-Moulton, 


I 


« 
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integration  procedure.  This  subroutine 

o  - 

is  a  modified  form  of  *  the  IBM  360  sub- 
..  • 

«■  program  DFEQ. 

KALMAN  -  Processes  the  filter  equations  and  provides 

the  best  estimate  of  the  errors  in  position 

*  \ 

and  velocity  following  a  radar  observation. 

j  , 

This  error  estimate  is  then  used  to  update 
i ,  the  nominal  trajectory. 

SDM  •-  Computes  the  system  description  matrix 
.  '  .  "  (Eq  29) .  0 

■i  C*  .  .  ...  .  "  U 

r  •  »  0 

Subordinate  Subroutines,  These  subroutines  are  used 
within  the  operational  subroutines  to  perform  mathematical 

*,o  '•  , 

and  plotting  operations. 


DET' 


SINV 


MFSD 


MPRD 


MTRA 

hfCPY 

DRAW 


-  Computes  the  determinant  of  a  function 

-  Invents  a  given  symmetric  positive  definite 
matrix  • 

C  '  \  1  0.  . 

Factors  a  given  symmetric  positive  def  inite 

-  *"  ’  c  -v 

matrix  ■  ’ 

*  ■/>. 

-  Multiplies  two  matrices 

'  *  9  * 

„  '  ,  -  '  *  ^  "o  ' 

•  Computes  a  vector  subscript  for  an  element 

•  '  /  '  *  . 

‘  %  g 

in  a  matrix  of  specified  storage  mode 

•  “  •  ■>  ■■  t 

(needed  fpr  MPRD) 

.  •  *  .  '  •;  ;/;• : 

-  Transposes  a  matrix 

-  Copies  an  entire  matrix  (needed  for  MTRA) 

°  '  •  *  ,  0  o 

:-  Draws  a  graph  using  Cartesian  coordinates 


PLOTS  -  Initiates  the  plotting  routine 

«.  C,  .. 

PLOTE  -  Terminates  the  plotting  routine 
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V.  Presentation  and  Analysis  of  Results 

p  '  . 

Available  Data 

c  The  data  used  in  the  computer  simulation  was  provided 

*'  ■**  **  »  ,  » 

by  the  Space  Detection  and  Tracking  System  (SPADATS), 

located  at  Colorado  Springs,  Colorado.  Four  different 
satellites,  whose  orbital  paths  ranged  from  highly 
elliptical  to  nearly  circular,  are  used  in  the  study. 

The  input  radar  measurements  consist  of  the  range, 
range  rate,  azimuth,  elevation,  and  azimuth  and  elevation 
rates  of  the  satellites  being  tracked.  Since  the  azimuth  , 

and  elevation  rates  are  not  always  provided,  it  is  some- 

I 

times  necessary  to  estimate  them  based  on  two  consecutive 
values  of  azimuth  and  elevation.  This  estimate  is  only 
required  for  the  determination  of  the  initial  nominal 
trajectory.  For  all  subsequent  observations  only  range, 
range  rate,  azimuth,  and  elevation  inputs  are  needed. 

The  radar  stations  used  to  obtain  the  necessary 

f, 

tracking  data  are  listed  in  Table  1  along  with  their 
latitudes,  longitudes,  height  above  sea  level,  and 
sensor  sigmas  and  biases.  The  sensor  sigmas  are  squared 

r 

and  used  as*  the  diagonal  terms  for  the  measurement  error 
covariance  matrix  R,  and  the  sensor  bias  values  are 

used  to  correct  the  measurement  values  at  each  observa- 

\  c 

tion  time.  The  bias  corrections  are  necessary  because 
of  the  assumption  of  a  zero  mean  noise  vector.  Table  II 
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/ 

/ 
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Table  1 

/ 

RAdar  Tracking  Stations 


Station  I  Statldn 
Parameter  I  342 


Latitude 

(Deg) 


Longitude I +359 . 33  +291.71  +210.81 


Height  276. 
(meters) 


Station 

349 

Station 

337 

+64.29 

+37.01 

+210,81 

+39.99 

240.00 

915.00 

Sigmas  | 


0.50 


Azimuth  I  0.02 


Elevation!  0.02 


2.00 


B 


.00 


6 


0.05 


0 


1.20 


3 


0.03 


2. 


0.09 

0.06 

0.10 

0.02 

0.07 

0.03 

5.00 

1.00 

-0.40  -0.80  -1.30  +0.30  +0.03 


Azimuth  I  +0.03  +0,05  +0.04  -0.03  -0.08 


Elevation  I  +0.02  +0,06  -0.02  -0.32 


10.2 


10.1 


/ 


*t>  - 

/ 
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Table  II  \ 

Nominal  Elements  Computed  Before  Launch 

Element 

Satellite 

3823 

Satellite 

3824 

Satellite 

3825 

Satellite 

3826 

Period 

(Min) 

93.83 

l 

95.27 

154.04 

90.84 

Inclination 

(Deg) 

99.42 

99.05 

105.00 

99.28 

Eccentricity 

0.000008 

0.011 

0.28 

0.02 

Apogee 

(NM) 

249.4061 

O 

330.000 

3142.70 

245.91 

Perigee 

(NM) 

249.3481 

249.387 

249.05 

94.99 

Argument 
of  Perigee 
(Deg)  -  . 

172.36 

179.32 

r 

178.20 

106.00 

Semi -Major 
Axis  (NM) 

3693.31060 

3733.627 

5139.81 

3614.38 

1  •  -  - 

Injection 
Height  (NM) 

249.3481 

249.388 

249.05 

245.91 

Injection 

Latitude 

(Deg) 

7.691 

7.696 

1.74 

,  2.35 

Injection 

Longitude 

(Deg) 

228.809 

228.805 

226.71 

4.09 

Injection 
Time  After 

L/0  (Sec) 

699.2 

i 

731.9 

970.7 

3239.1  ' 

(From  Ref  11s  2) 
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presents  the  nominal  elements  for  each  of  the  satellites 
as  computed  prior  to  launch. 

The  computed  orbital  elements  obtained  in  this  study 
are  compared  with  values  supplied  by  SPADATS.  For  three 
satellites,  only  one  set  of  elements  for  both  days 
covering  the  time  of  observations  are  provided  by  SPADATS. 
In  addition,  the  exact  time  of  day  when  the  orbital 
elements  are  calculated  by  SPADATS  is  not  available. 

As  a  result,^  it  is  usually  impossible  to  have  the  times 
of  computation  coincide,  thereby  preventing  any  precise 
comparison  of  results. 


Introduction  to  Computer  Results 

The  computer  runs  used  to  evaluate  the  application 
of  the  Kalman  Filter  to  orbit  determination  are  divided 
into  four  groups.  The  first  group  of  runs  are  used  to 
determine  the  basic  effectiveness  of  the  filter  when 

applied  to  tracking  data  for  each  of  the  four  satellites. 

■ 

The  second  group  of  computer  runs  use  observations  from 
the  same  pass  as  the  initial  runs,  but  from  different 
stations,  and  also  data  from  one  to  three  passes  earlier 
or  later  than  the  initial  runs.  These  runs  provide 
a  means  of  checking  the  changes  in  the  results  caused 
by  different  tracking  stations  and  different  passes. 

The  third  group  of  runs  investigates  what  would  happen 
if  several  observations  are  skipped  from  within  a  series 
of  observations.  The  last  group  consists  of  several 
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tuns  to  check  the  effects  of  varying  the  number  of 
terms  in  the  equation  used  to  compute  the  state  transition 
matrix.  A  run  is  also  included  Which  utilizes  the 
longest  single  track  of  observations  found  in  the  avail¬ 
able  data. 

Group  1  Results 

\ 

The  initial  computer  simulation  is  made  up  of  ten 
computer  runs  as  shown  in  Table  Ill.  The  input  data  for 
each  run  consists  of  a  series  of  radar  observations 
made  by  a  single  tracking  station  during  one  pass  of 
the  satellite.  The  satellite  is  usually  tracked  over 
a  period  of  four  to  five  minutes  during  each  pass,  and 
observations  are  recorded  at  intervals  of  either  10.1 
or  6.0  seconds.  In  order  to  begin  the  filter  algorithm, 
it  is  necessary  to  estimate  the  initial  error  covariance 
matrix  P(0).  At  the  start  of  each  run,  the  linear  error 
vector  is  expected  to  be  zero  since  the  satellite  is 
assumed  to  be  on  the  nominal  trajectory.  The  confidence 

•*  9 

in  this  assumption  is  expressed  by  the  initial  values  of 

*  *  \ 

the  covariance  matrix.  The  recommended  procedure  is 
to  underestimate  the  off-diagonal  (cross-correlation) 

#  •  J  . 

terms  and  overestimate  the  diagonal  (auto-correlation) 

„  -A 

v  ®  o 

terras.  Therefore,  all  the  off-diagonal  terms  of  the 
6x6  error  covariance  matrix  are  initially  set  to  zero, 
and  the  different  combinations  chosen  for  the  diagonal 

n  >  .  V  ' 

terms  are  shown  in  Table  III. 
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The  results  obtained  In  the  first  ten  computer  runs, 
along  with  results  provided  by  EPADATS,  are  showri  in 
Table  IV.  The  approximate  time  when  the  orbital  elements 
are  computed  by  SPADATS  are  from  three  to  eighteen  hours 
different  than  the  time  of  the  observations  used  in  the 
Group  I  runs.  RAdar  observations  are  usually  available 
at  the  time  when  SPADATS  computes  their  orbital  elements, 
but  they  are  not  of  sufficient  quantity  to  allow  the 
computer  algorithm  to  reach  steady  values  for  the  elements 
The  effects  upon  the  linear  error  estimates  caused 
by  using  three  different  values  for  P(0)  for  Satellite 
3825  are  shown  in  Figs.  4-9.  The  time  history  of  the 
diagonal  elements  and  two  off-diagonal  elements  of  the 
error  covariance  matrix  are  shown  in  Figs.  10-15.  The 
resulting  orbital  elements  are  plotted  versus  time  in 
Figs.  16-18.  Similar  curves  for  only  one  value  of  P(0) 

*< 

are  presented  in  Figs.  19-33  for  Satellites  3826,  3824, 

\ 

and  3823.  The  P(Q)  chosen  is  the  one  which  gave  the 
*  ' 
best  overall  results  for  each  satellite,  Additional 


plots  produced  by  using  other  initial  values  for  the 

a  6  . 

error  covariance  matrix  are  presented  in  Appendix  E. 


For  each  satellite,  it  is  possible  to  obtain 


t 


convergence  of  the  error  estimates  to  values  less  than 
0.1  per  cent  of  the  adtual  values  of  position  and  velocity 


The  number  of  observations  needed  to  obtain  convergence 


Satellite  Source  Approximate  Time  Semi-Major  Eccentricity  Inclination  Line  of 
of  of  Computation  Axis  (ER)  (Deg)  Nodes 

Result*  Pass  Day  Hour  -  -fDeg) 

3825  SPADATS  78  3  1.4884  0.2789  104.815  342.70 
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.  ;  r  , 

varies  from  a  minimum  of  10  (100  seconds)  to  a  maximum 

of  24  (240  seconds).  The  rate  of  convergence  is  related 

/  * 

to  the,,  initial  estimate  of  the  error  covariance  matrix, 

'  y  *  V  ^  1  •  5  I  > 

along  with  the  measurement  accuracy  of  the  tracking 

stations.  Underestimating  P(0)  delays  convergence, 
which  in  turn  prevents  the  orbital  elements  from  reaching 
steady  values.  Overestimating  P(0)  greatly  improves  the 

rate  of  convergence,  and  this  also  results  in  very 

< 

steady  orbital  elements  in  the  minimum  time. 

.  i 

V  J  l 

The  major  discrepancy  in  the  Group  1  results  is 
the  value  obtained  for  the  semi-major  axis  for  Satellite 
3825  as  compared  to  the  value  provided  by  SPADATS.  The 
measurembnts  for  Satellite  3825  are  obtained  from  Station 
/*  349,  and  these  measurements  contain  larger  bias  errors 

•  •  ;  o  ••  •  / 1 

|nd  sigmas  (standard  deviations)  than  any  of  the  measure¬ 
ments  from  the  other  tracking  stations  used,  as  shown  in 

,  ■  .  V  * 

Table  I,  This  fact  provides  a  possible  explanation  for 
the  discrepancy  in  the  answers  obtained  by  using  data 
from  Station  349. 

The  Line  of  Nodes  angle  had  a  positive  time  rate 

s  ■ 

of  change  which  is  a  function  of  the  inclination  angle, 
and  eccentricity.  This  rate  of  change  varies  from  0.08 
to  0.2  degrees  per  revolution  for  the  four  satellites, 
and  accounts  for  some  of  the  discrepancy  between  the 
computed  values  of  the  Line  of  Nodes  and  those  values 
provided  by  SPADATS. 
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Group  II  Results 

The  purpose  of  the  six  computer  runs  in  this  group 
is  to  determine  if  the  orbital  elements  obtained  in 
Group  I  are  repeatable.  The  passes  of  each  satellite 
for  these  correlation  runs  are  chosen  as  close  in  time 
as  possible  to  those  in  the  original  runs.  Table  V 
presents  the  satellites  and  stations  used,  the  number 
of  observations  for  each  tun,  and  the  initial,  maximum, 
and  minimum  yalues  of  range  and  elevation  encountered 
during  the  radar  track.  Table  VI  compares  the  results 
obtained  in  the  correlation  runs  with  the  corresponding 
runs  from  Group  I.  Also  included  are  the  results  from 
an  additional  correlation  run  for  Satellite  3825,  A 
plot  of  the  orbital  elements  versus  time  for  each  run 
are  shown  in  Figs,  34-39,  vfaile  additional  curves  for 
the  error  estimates  and  error  covariance  elements  ore 
shown  in  Appendix  E. 


Group  II  Analysis 

The  orbital  elements  obtained  in  the  correlation 


runs  compare  quite  favorably  with  those  from  Group  I. 

The  most  noticeable  discrepancy  is  once  again  the  semi¬ 
major  axis  for  Satellite  3825.  Runs  12  and  16,  which 
use  tracking  data  from  Station  349,  result  in  a  semi¬ 
major  axis  slightly  higher  than  the  SPADATS  value.  How¬ 
ever,  Run  15,  Which  uses  observations  of  Satellite  3825 
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Table 


apart 


Table  VI 


GGC/EE/70-7 


from  Station  365,  yield?  a  semi -major  axis  which  is 
very  close  to  the  SPADATS  value.  An  analysis  of  Station 

t 

365  shows  that  the  measurements  for  this  station  hiive 

much  smaller  bias  errors  and  sigmas  than  Station  369 

(Table  I),  This  fact  provides  a  possible  explanation 

for  the  discrepancy  in  the  answers  for  the  semi-major 

axis  when  using  tracking  data  from  Station  369. 

The  results  shown  in  Table  VI  for  Run  12  are  taken 

after  21  observations  have  been  processed.  After  this 

point,  the  orbital  elements  begin  to  change  and  the  final 

answers  are  quite  a  bit  different  from  those  provided  by 

SPADATS.  This  change  can  probably  be  attributed  to  the 

elevation  angle  which  rose  quite  rapidly  near  the  end, 

and  reached  a  final  value  of  nearly  83  degrees. 

It  is  possible  to  obtain  steady  values  for  the 

orbital  elements  in  only  50  seconds  (6  observations)  for 

Run  16,  and  in  68  seconds  (8  observations)  for  Run  13, 

Very  good  orbital  elements  are  obtained  for  Satellite 

3826  using  tracking  data  from  Station  369,  as  shown  in 

•  • 

* 

Fig.  38.  Therefore,  this  station  provides  only  fair 
elements  for  an  elliptical  orbit,  but  very  good  elements 
for  a  circular  orbit. 

Group  III  Results 

The  actual  series  of  measurements  obtained  during 
a  single  radar  track  of  a  satellite  often  contain  from 
one  to  six  missing  observations.  The  purpose  of  Group 

r 
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III  is  to  determine  if  a  number  of  consecutive  observa¬ 
tions  can  bo  omitted,  and  still  achieve  good  results 
for  the  orbital  elements. 

In  order  to  have  a  basis  for  comparison,  the  satr.o 
tracking  data  end  input  F(0)  used  in  Run  2  and  Run  7  of 
Group  I  are  used  in  this  group  of  runs.  These  measure¬ 
ments  are  for  Satellites  3325  end  3024,  respectively, 
which  represent  both  highly  elliptical  and  nearly  circular 
orbits.  Run  17  uses  the  data  from  Run  2  (Satellite  3825) 
with  eight  consecutive  observations  removed  after  10 
seconds,  and  Run  18  uses  the  data  from  Run  7  (Satellite 
3824 )  with  eight  consecutive  observations  removed  afte;: 

50  seconds.  Table  VII  presents  a  comparison  of  the  results 
from  the  original  tV7o  runs,  the  values  provided  by  SPADAT5, 
and  the  results  from  Runs  17  and  18.  The  graphical  results 
are  shown  in  Figs.  40  to  51, 


Analysis  of  Group  III  Results 

The  computer  algorithm  is  able  to  perform  quite 
successfully  with  eight  consecutive  missing  observations. 
Preliminary  runs  (not  included)  using  the  same  data,  but 
with  skips  of  two,  four,  and  six  observations,  produced 
results  which  are  as  good  or  better  than  the  results  for 
Runs  17  and  18.  ; 

It  is  quite  interesting  to  note  the  behavior  of 
the  error  covariance  matrix,  P(-),  which  is  computed 
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from  Eq  14  (Chapter  II) 


Pm+l<->  = 

m+i  ro  m  m 


(49) 


This  matrix  equation  is  used  to  propagate  the  error 
covariance  between  measurements.  Representative  matrix 
elements  are  shown  in  Figs.  49  and  50  for  Run  7,  which 
contains  no  shipped  observations,  and  these  can  be 
compared  v;ith  the  same  elements  in  Figs.  47  and  48  for 
Run  17,  which  contains  eight  skipped  observations. 

During  the  time  period  covering  the  skipped  data,  the 
matrix  elements  for  the  two  runs  are  quite  different. 
However,  onco  the  skips  are  terminated  and  several  nev; 
measurements  are  received,  the  values  for  the  elements 
for  both  runs  quickly  becomes  almost  identical.  It  should 
bo  not  ..  that  the  scales  for  Figs.  47  and  49  are  not 
the  same,  causing  the  curves  to  appear  different,  even 
after  the  skips  are  over.  But  upon  closer  analysis, 
it  can  bo  seen  that  after  approximately  100  seconds  the 
curves  arc  very  similar.  Thus,  despite  the  large  change 
in  P(-)  during  the  time  of  the  skipped  observations,  the 
Kalman  Filter  continues  to  operate  properly. 


Group  IV  Results 

The  state  transition  matrix  is  computed  using  Eq  (13) 
which  is  repeated  belov? 

2  2  3  3 

<3>  r,  1  +  FAt  +  F  At  /2I  +  F  At  /3!  +  h.o.t.  (50) 
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where  h.o.t.  represent  the  higher  order  terms.  All  the 
previous  runs  in  Groups  I-II1  used  the  first  four  terms 
shown  in  Eq  (44),  and  the  question  arose  as  to  how  much 
the  results  would  be  affected  by  either  adding  or  sub¬ 
tracting  terms  from  this  equation.  To  answer  this 
question,  Rune  3,  5,  and  9  (Group  I)  arc  each  repeated 
using  two  different  equations  for  the  state  transition 
matrix.  Hie  initial  set  of  runs  use  only  the  first 
two  terms,  while  the  second  set  of  runs  include  the 
first  five  terms. 

In  each  sot,  the  resulting  orbital  elements  are 
the  same  as  the  Group  I  results  out  to  the  fifth  or 
sixth  significant  digits.  A  comparison  of  the  graphical 
results  for  each  set  of  runs  also  fails  to  disclose  any 
appreciable  differences.  Because  of  this  similarity, 
the  results  are  not  included  in  this  report. 

In  most  of  the  previous  runs,  the  tracking  data 
from  a  single  radar  station  during  one  pass  seldom  lasts 
over  five  minutes.  However,  one  set 'of  data  is  available 
from  Station  345,  Satellite  3825  which  covers  a  time 
interval  of  nearly  nine  minutes.  Within  this  data, 
there  are  a  number  of  missing  observations  (25)  which 
occur  in  groups  of  from  one  to  three  over  the  last  270 
seconds.  Because  of  the  interesting  nature  of  this 
data,  one  additional  run  is  made,  and  the  graphical 
results  are  shown  in  Figs.  52-56. 


.',3  TD  I,yiN3333 


U  V  i  UU  JU  I  ,  J  'JJ  IIIM  ;  '  | 

fS33«03Q)!  N'OIiLyNinONlI 


g 

jgj 

g 

|gjp#i 

SB 

B 

gg 

B 

B 

mm 

B 

g 

II 

B 

B 

IB 

B 

g 

B 

B 

IB 

B 

B 

i 

3 

ii 

3 

I 

1 

3 

F  )|Gi 

S 

■ 

Kg 

1 

(IB 

in 

H 

5»S 

F 

jg 

B 

B 

■ 

i 

ra 

B 

B 

Bjg 

2 

g 

B 

3 

B 

B 

B 

S 

MB 

jg 

5 

g 

B 

n 

IB 

8 

B 

B 

B 

.IB 

| 

§ 

B 

g 

1 

B 

B 

s 

B 

g 

■HI 

IB 

B 

1 

i 

m 

1 

B 

g 

B 

IB 

9 

B 

B 

3 

mm  mb' 

ft] 

S 

B 

■B 

vi 

B 

B 

ill 

j 

i 

3 

gg| 

H 

B 

Ba 

■bBB 

H 

B 

BB 

■ 

1 

| 

jj| 

■ 

B 

BBS 

fij 

B 

B 

■ 

Satellite  3325  Station 


GGC/EE/70-7 


Analysis  of  Group  IV  Results 

In  analyzing  Eq  (50),  it  is  found  that  the  largest 
elements  making,  up  the  F  matrix  are  on  the  order  of 
0.0001.  Jn  addition,  the  value  for  At  5  s  a  constant  0.1. 

Thus,  the  ter  vis  in  Eq  (50)  beyond  the  second  tern  (i.e. 

2  2 

F  At  /2  +  •  •  •)  have  maximum  magnitudes  which  ere  less 
than  10  end  the. so  terms  are  therefore  very  insigni¬ 
ficant  when  added  to  the  identity  matrix  1. 

The  computer  run  urinj:;  the  nine  minute  track  of 
Satellite  3825,  produces  steady  values  for  the  orbital 
elements  after  approximately  200  seconds,  as  shown  in 
Fig.  56.  By  using  smaller  values  for  the  initial  error 
covariance  matrix,  P(0),  the  orbital  elements  take  longer 
to  reach  steady  levels,  once  again  indicating -that  it 
is  best  to  overestimate  diag  F(0).  The  run  could  have 
been  terminated  after  the  steady  values  are  reached 
since  the  orbital  elements  c re  essentially  unchanged  for 
the  final  55  observations.  The  final  value  for  the  semi- 
tnajor  axis  (1.4927)  is  higher  than  the  value  provided 
by  SPADATS  (1.488)*  Therefore,  even  by  using  data  from 
two  different  tracking  stations  (345  and  349),  a  consis¬ 
tently  high  value  has  been  obtained  for  the  semi-major 
axis  for  Satellite  3825.  A  possible  explanation  could 
be  that  the  value  computed  by  SPADATS  is  in  error. 
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VI.  Conclusions  and  Recommendations 


Conclusions 

1.  The  application  of  the  ICalman  Filter  to  deters 
mine  the  orbit  of  a  space  vehicle  is  quite  successful. 
For  each  of  the  four  satellites  used  in  the  study,  it 

is  possible  to  obtain  convergence  of  the  error  estimates 
to  values  less  than  0.1  per  cent  of  the  actual  values  of 
position  and  velocity.  When  measurements  spaced  six 
seconds  apart  are  used,  convergence  is  achieved  with 
a  minimum  of  eight  observations.  For  measurements  ten 
seconds  apart,  a  minimum  of  six  are  needed  to  obtain 
convergence.  The  value  chosen  for  the  initial  error 
covariance  matrix  greatly  affects  the  rate  of  conver¬ 
gence,  and  in  general,  overestimation  provides  steady 
orbital  elements  In  the  shortest  time.  Once  conver¬ 
gence  is  reached,  the  optimal  estimate  of  the  trajectory 
is  obtained,  and  additional  measurements  fail  to  improve 
this  trajectory. 

2.  The  orbital  elements  are  repeatable  for  three 
of  the  satellites  when  using  tracking,  data  from  different 
radar  stations.  The  orbital  elements  are  repeatable  for 
the  fourth  satellite  when  using  tracking  data  from  the 
sane  radar  station  for  two  consecutive  passes. 

3.  The  computer  algorithm  is  capable  of  integrating 
for  over  80  seconds  with  no  tendency  to  diverge. 
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Therefore,  as  many’  as  eight  consecutive  measurements 
spaced  10  seconds  apart  can  be  missing  from  within  a 
track  of  a  satellite,  end  the  program  v/ill  still  pro¬ 
vide  good  results.  Jf  the  missing  observations  occur 
before  convergence  is  reached,  then  several  additional 
measurements  are  needed  following  the  skips  in  order 
to  obtain  steady  values  for  the  orbital  elements. 

4.  l«hen  computing  the  state  transition  matrix,  only 
the  first  two  terms  of  the  series  expansion  arc  needed, 
and  all  additional  terms  are  negligible. 

Recommends ti  onr. 

The  following  topics  are  suggested  as  areas  for 
further  study. 

1.  Use  tracking  data  for  satellites  with  low  end 
intermediate  inclination  angles. 

2.  Include  perturbation  terms,  such  as  atmospheric 
drag,  solcr  drag,  and  additional  zonal  harmonic  terms, 
in  the  nonlinear  state  equations. 

3.  Include  tracking  data  for  both  continuously 
thrusting  and  intermittently  thrusting  vehicles. 

4.  Extend  computer  algorithm  to  include  iterative 
differential  correction  techniques  as  outlined  by 
Morrison  (Ref  14i 428-482). 

5.  Extend  the  dimension  of  the  state  vector  and 
filter  matrices  in  order  to  include  the  station  biases 
and  sigmas  in  the  estimation  process  (Ref  7i 241-242).. 
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Appendix  £ 


Initial  Fovirtal  Tra  jectory  Emotions 

The  equations  used  to  compute  the  initial inominal 
trajectory  are  presented  in  this  appendix.  Th6  input 
data  needed  includes  the  following! 

1.  Height  of  tracking  station ,  h(metexis) 

2.  Latitude  of  pranking  station,  <f>  (degrees) 

3.  Longitude  of  tracking  station,  0(clegrees) 

4.  Slant  range  of  satellite,  p (meters) 

5.  Slant  range  rate  of  satellite,  p  (raeters/second) 

6.  Azimuth  of  satellite,  A(  degrees) 

V  ’  • 

7.  Elevation  6f  satellite,  E(degrees) 

8.  Azimuth  rate  of  satellite,  A(degrees/second) 

4  '  /  *,  • 

9. '  Elevation  rate  of  satellite,  E(d'ec,rees/second) 


Computation  of  Station  Coordinates  in  Rotating  Frame 


X  -(C+H)cos(0)cos(^) 

/ 

R  ss  Y  =  ;*(C+H)cos(0)sin(0) 

Z  -(S+K)sin(0) 


(A-l) 


\7herc  II  is  the  station  height  in  earth  radii,  and 

r  2  i1/2 

C  =  l/[l  -  (2f-f  )sin  (0)] 

S  =  c(i-f)2 


(A-2) 

(A-3) 


f 
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Computation  of  Vectors  L  and  L  in  Rotating  Frame 


’lx" 

'cos(0)(-Ll+L2)  -  sin(0)(L3) 

L  = 

LY 

- 

cin(0)(-Li:L2)  •!-  cos(0)(L3) 

_LZ_ 

_cos(0)cos(h)cos(A)  +  sin(<£)sin(h)_ 

where 

<  ‘  *' 

A 

Cf 


LI  s=  sin(0)cos(h)cos(A) 

I 

L2  ~  coc(0)sin(h) 

L3  K  cos(h)sin(A) 


(A-5) 
(A-6) 
(A- 7  ) 


LXD 

LY.0 


LLZDj 


where  LXD  :=  (A)cos(0)sin(^)sin(A)cos(h)+ 

(E)cosC0)sin(0)cin(h)cos(A)+ 

•  t 

(E)cos(0)cos(0)cos(h)- 
‘ (A)cos(A)sin(0)cos(h)+ 
(E)sin(0)sin(A)sin(h) 

I  , 

LYD  *a  (A)sin(0)sin(0)sin(A)cos(h)+ 
(E)sin(0)sin(0)sin(h)cos(A)+ 
(E)sin(0)cos(0)cos(h)+ 
(A)cos(0)cos(A)cos(h)- 
(E)cos(0)sin(h)sin(A) 


(A-8) 


(A-9) 


(A-10) 


0 
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LZD  =  (-A)cor(0)sin(A)cos(h)- 
(E)cos(0)cos(A)sin(h)+ 
(E)sin(0)cos(h) 


(A-ll) 


Computation  of  Satellite  Position  Components  in 
Rotating  Frame 


/ 


r  = 


y 

z 


—  pL  —  R 


(A-12) 


/  ■ 


Computation  of  Satc3 lite  Velocity  Components  in 

•j 

Rotating  Frame 


r  =s 


y 

Z 


=  PL.  +  PJ, 


(A-13) 


*•  x 


\ 
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Appendix  B 

/ 

:  * 

S*  stem  Description  Matrix 

The  system  description  matrix  F  is  made  up  of  the 
partial  derivatives  of  the  equations  of  motion  with 

•  ■I 

respect  to  the  states  x,  y,  z,  x,  y,  z,  as  given  by 
Eq  (23)  in  Chapter  III. 


% 


F41  =  *Vr3[3(x/r)2-l]  [l+llj  -  xHflX  +  <u2 

(B-l) 

f42  «  Mx/r3  (3y/r2)(l-i-Hfl)  -  Hfiy 

<B-2) 

✓ 

f43  «  #ix/r3  (3z/r2)(l+Hfl)  -  HflZ 

(B-3) 

F44  a  F46  0 

r 

F45  **  2a> 

(B-4X 

i 

t  (B-5) 

\  *  - 

„  \  0  • 

f51  «py/r3  (3x/r2)(l+Ha)  -  HflX 

(B-6) 

f52  *  M/r3  [3(y/r)2-l][l+HaJ  -  yHay  +  «2 

(B-7) 

f53  b  py/r3(3z/r2)(l+Hfl)  -  H^z 

(B-8) 

f54  =  -2<y 

• 

(B-9) 

•» 

F55  *  f56  b  0 

(B-10) 

■  itifl.ii.tf.. 
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where  the  terms  Ha,  HflX»  Hay,  an<*  ^az  are  B^-vcn 


H.  =  ^^S[l-5(z/r)2]  4  ^^£[3-7(s/r)2]z/r  (u-11) 


a  2r2 


3 Jo A2x 


H 


2  e 


[l0(z/r)2-l]  +  i^2[ 7(z/r)2-2]  (B-12) 


ax  *'  r4 


3JoA2y  15J3yzA^  2 

Hay  ”  “7H~E0(55/r)  -1]  +  -  -[7(z/r)Z-2j  (B-13) 


H _ = 


6j2 hlz 


15J3a3 


az 


[5(z/r)2-3]  +  - ~[o.5-5.5(z/r)2+ 


7(z/r)A  ]  (B-1A) 


P61  =  pz/r5  (3;:/r2)(lillh)  -  II, 


bx 


CB-15) 


f62  c  l*z/r3  (3y/r2)(l+i?b)  -  Hby 


(B-16) 


f63  =  "/r3  [3(zA-£l][l+Hb]  -  zllbz 


(B-17) 

<9- 


F64  “  f65  =  f66  =  0 


(B-18) 


where  the  terms  Hb,  Hbx,  Hby,  and  Hbz  are  given  by 


3  J9  A2 
2  e 


H  =  __ 

0  o^Z 


5*J 

[3-5(z/r)2J  +  — ^^|6-7(z/r)2Jz/r  (B-19) 


2r' 


2r 


1! 


J2A?x 


bx 


Aex  r  ?  1 

—  30(z/r)Z-9j 


2  ~l  15J3Aexz 


j7(z/r)2-A*J  (B-20) 
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Appendix  C 


Measurement  Matrix  M 


The  measurement  matrix  M  is  made  up  of  the  partial 
derivatives  of  the  measurements  P,  P,  A,  and  E  with 
respect  to  the  states ,  position  and  velocity. 


M  = 


M(l) 
M(2) 
H<  3) 
M(4) 


dP 
3xt  (\y 


•  •  • 


dz 


£ . M 

d"  bz 


(C-l) 


where  the  terms  M(l),  H(2),  M(3),  and  M(4)  are  given  by 


M(l)  =  \\y*r.)/P,  (y+Y )/p,  (z*Z)/p,  0,  0,  o] 

Mm  b  f£  o(x+X)  y  p (y+Y )  z  p(z+Z)  x+X 
[p - "  "  >r~  ~  "  “ 


(C-2) 


y+Y  z+Z*l 

P  .  P  J 


(C-3) 


H(3)  =  [l/(p2-z?  )J  |^-x^sin(0)-y^sin(0)coc(0) ,  x^cos(0)- 


yTsin(tf>)sin(0),  y^cosC^) ,0, 0,oj 


(C-4) 


M(4)  =  Tl/CP^-z^)^^  cos(0)cos(0)-zt(x-X)/p^# 

L  JL  r% 


2  2 

isin(0)cos(^)-zT(y-Y)/P  ,  sin(0)-zr|,(z-Z)/P  f 


'.0.  o] 


(C-5) 
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Appendix  D 


Commit  or  Program 

The  computer  program  listing  is  presented  in  this 
appendix,  alone  v?ii:h  a  corr.-won  listing  of  tho  variables 
used  in  the  program,  and  a  sample  of  the  required  input 
data.  Tho  prog  ran  is  vritten  in  Fortran  J.V  language 
for  use  on  the  IBM  7096  computer  located  at  Wright- 
Pat  terson  Air  Force  Base,  Ohio. 
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*«*  COMMON  LISTING  *** 


C( 

1  ) 

T 

T  IMF 

C( 

3) 

C( 

3) 

tu 

I NTCGRAT I  ON  STEP  SIZE 

c< 

4  ) 

SORf'U 

SOUARE  ROOT  OE  MU 

C( 

5) 

r*T4 

OT3«DT/4*0 

C( 

6) 

V'IFKi 

ANGULAR  ROT  AT  AT  1 ONAL  RATE  OE  EARTH 

C  ( 

7) 

r-T3 

PT3*DT /3 *  0 

c< 

8) 

0T3 

PT*PT/3.0 

C( 

9) 

VO 

CIRCULAR  SATELLITE  SPEFP 

c< 

1  0) 

Af* 

RAP  I US  OF  FARTH 

c  < 

1  1  > 

cc 

13) 

MU 

GRAVITATIONAL  CONSTANT  (=1*0) 

C( 

13) 

'  Wr  «  W  I ;r 

ANGULAR  ROTATIONAL  RATE  OF  FARTH 

C( 

14) 

V.'E  3  «  W  I  F  3 

V.‘E*V'F 

C  ( 

1  ‘-5) 

F 

FLATNESS  COEFFICIENT 

c< 

1  6) 

KE 

CONSTANT 

C( 

17) 

J3 

CONSTANT 

C( 

1  8) 

J3 

CONSTANT 

C( 

19) 

MUM  FT 

CONSTANT  (MU  FOR  METFR  UNITS) 

C( 

30) 

T I 

time  interval  measurements 

c< 

31  ) 

C( 

33  ) 

C( 

33) 

C( 

34  ) 

c< 

35) 

FR 

FLEVAT I ON  BIAS 

c< 

36) 

AB 

AZIMUTH  BIAS 

C< 

37) 

RB 

RANGE  BIAS 

C( 

30) 

RPB 

RANGE  RATE  BIAS 

C( 

39) 

HOUR 

HOUR  OF  OBSERVATION 

C( 

30 

MI NUTT 

MINUTE  OF  OBSERVATION 

c< 

31  ) 

HP 

HEIGHT  AT  PERIGEE 

C( 

33.) 

NO 

NUMBER  OF  OBSERVATIONS 

C( 

33) 

C  ( 

34  ) 

c< 

35) 

c< 

36) 

C( 

37) 

C( 

38) 

C( 

39) 

C( 

40 ) 

C( 

41  ) 

THRU  C<  49) 

CLT ( 1 « 1 )  THRU  CLT ( 3  «  3 ) 

C  ( 

50  ) 

C( 

51  ) 

RHOM 

EHO  MEASURED 

c< 

53) 

PMODM 

RHO-DOT  MEASURED 

C  ( 

53) 

AM 

AZIMUTH  MEASURED 

C{ 

54  ) 

FM 

FLEVAT I  ON  MEASURED 

C( 

55) 

C  ( 

56) 

RHOC 

RHO  CALCULATED 
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CC  57) 

phodc 

PHO-DOT  CALCULATED 

CC  58) 

AC 

A7.VUTH  CALCULATED 

C<  59) 

FC. 

FLFVAT  1  OV  CALCULATED 

C(  60) 

CC  61  ) 

AO 

A  7  J  MUTM-OOT 

CC  62) 

FD 

FL~VA7  ION— DO'' 

C<  62) 

C  (  64  ) 

* 

C(  65) 

C(  66) 

4 

C(  67) 

C(  68) 

C(  69) 

C(  70) 

PER 

r*r  ° !  on 

C(  71  ) 

A 

I -MAJOR  AX! 5 

CC  72) 

F  CC 

f:  CC.rNfRICITY 

C(  73) 

J 

FPOCH  TIME 

C(  74) 

F 

r  CC  t-  NTS?  I C  ANOMAL  Y 

C<  75) 

V 

MEAN  ANOMALY 

C(  76) 

PDP .  UDU 

pot  pi?opuct  or  unit  vectors 

C<  77) 

PPG  «  UDV 

DOT  PRODUCT  O f7  UNIT  VECTORS 

CC  78) 

ANG 1 

I  l-.’CL  I  NAT  I  ON  AM  OLD 

CC  79) 

ANGALN 

ANGLE  TO  L I NF  Pr  NO PC 5 

CC  80) 

ANQAP 

ANGLE  OF  A P GUMP  NT  Or  P,“P  I  G^r 

CC  81  ) 

px»ux 

X - C OS* - '  ONE  N T  CF  P  OR  U 

CC  8?) 

PV«'JV 

y-comrom:-n?  or  p  or-  u 

CC  83) 

P7»U7 

Z-COMPONCNT  OP  P  09  U 

CC  84) 

OX*  VX 

X— COM°ON!“NT  or  Q  OR  V 

CC  85) 

OY  «  VY 

y-compo;j-:nt  or  o  or  v 

CC  86) 

CZ  »  VZ 

Z— COMPONENT  or  O  OR  V 

CC  87) 

WX 

X-COMPCr.CNT  Or  W 

CC  88) 

V/Y 

Y-COMPONENT  CP  V. 

CC  89) 

V!7 

z -component  or  V/ 

CC  90) 

CC  91  ) 

X 

POSITION  OF  SATELLITE  JN  METERS 

CC  92) 

Y 

POSITION  or  S ATFLL 1TE  IN  *VTrRS 

CC  93) 

7 

POSITION  or  satellite  in  meters 

CC  94) 

VX 

VELOCITY  OF  SATELLITE  IN  METERS/SEC 

CC  95) 

VY 

VELOCITY  OF  SATELLITE  IN  METE^S/S rC 

CC  96) 

V7 

VELOCITY  OF  SATELLITE  IN  M"TFRS/SEC 

CC  97) 

R 

MAGNITUDE  OE  SATFLt  ITT  POS  VECTOR 

CC  98) 

V 

MAGNITUDE  OF  SATELLITE  V^L  VECTOR 

CC  99) 

CC1GO) 

CC101 ) 

X 

POSITION  OF  SATFLLITr  IN  EARTH  RADII 

CC 102) 

Y 

POSITION  OF  SATFLL I Tr  IN  EARTH  PADI  I 

CC  103) 

7 

POSITION?  Cr  c  ATFLL  I TF  IN  FARTM  RADII 

CC104) 

VX 

VELOCITY  OE  SATELLITE  IN  FAPTL’  UNITS 

CC  105) 

VY 

VLLOC I TY  OF  SATELLITE  IN  FA PTH  UNITS 

CC106) 

V7 

VELOCITY  OF  SATELLITE  IN  F.ARTH  UNITS 

CC107) 

CC108) 

GC‘C/EE/70-7 


C ( 1  CO ) 

c  ( n  c) 

C (11  1  ) 

XP 

C  (  11  3  ) 

YD 

C  (1  1 3  ) 

ZD 

C  (  1  !  4  ) 

vx  ^ 

C  (  1  1  **, ) 

VY" 

C  (  1  I  C> ). 

V7D 

C  <-f  1  7  ) 

C  <  11  r, ) 

C  (11  ■> ) 

C.  {  1  3  0  ) 

- 

C  (  !  P  1  ) 

C ( 1 33  ) 

C  (  1  3  3  ) 

Tl  (■•GRO 

C  (  1 34  ) 

THETA 

C( IPO) 

- 

C( IPS) 

LA7 

C  (  1  3  7  ) 

LONG 

c  ( !  ?r. ) 

HT 

c  ( i  po ) 

TOOT 

C ( 130) 


C  (  1  3  1  ) 

XS 

r ( i or  5 

VS 

C  < 133) 

7S 

C  < 1 34  ) 

xvs 

C ( 1 30) 

VYS 

C( 130) 

vzs 

C ( 1 37 ) 

XS«  XGM 

C ( 1 3°  ) 

Y  S  4  Y  SM 

C  (  130 

C  (  1  A  0  ) 

ZS  4  Zc-M 

C  (  1  4  1  ) 

XVS 

C  (1  4  ?  ) 

YVS 

C  (  1  4  3  ) 

ZVS 

C  (  1  4  4  ) 

TH~’U 

C ( 1 44  ) 

C  (  1  0  7  ) 

SECOND 

C< IGF) 

THRU 

c tree ) 

C  (30)  ) 

C (337  ) 

T  l^PJ 

C ( 330 ) 

C  (33r* ) 

C (330) 
C  (340) 

n 

C ( 34  1  ) 

THRU 

C ( 304 ) 

C (36F ) 

C (300  ) 

p(  1 ) 

C (307 ) 

p(  » ) 

C (3F  f  > 

P(  3  ) 

C ( 30 f  ) 
C  (  3  7  r  ) 

p(4  ) 

C ( 3  7  1  ) 

CL'  '  ) 

r(3'  4  ) 

DFP1  VAT  ivrr,  fop  INTEGRATION 
ni  piv/.tiv  s  rop  integration 
of  f-’ i vat i vr  r.  f  oi ■>  I ntc gpat l on 
nr:r;ivMivr?  ro;-?  integration 
off i vat i vr  s  fop  i nttgrat i on 
of t? iv at i vr s  fop  integration 


I  rv  I  T  i  AL  GPvrNv.'IGH  T I  Mr-  - 
f/F*AN  A  I  OFPn  .AL  T  I  ME  (  GPff  NV/ 1  Cl ! ) 

LATITUDE  OF'  STATION 
LONGITUDE  OF  STATION 
HP.  I  GOT  CF  STATION 
THETA-DOT 

i 

GEOCENTRIC  COORD  OF  STATION  IN  F*P. 

geocentric  coord  or  station  in  e*r. 
GFOGF  NTP I C.  COORD  O-  STATION  IN  F*P. 


GFOCFNTPIC  COORD  OF  STATION  <M> 
Crorr-NTPir  COORD  of  STATION  <  M ) 
GFOCFNTPIC  COORD  OF  STATION  ( ) 

"»• 

COMPONENT  OF  SATF1.L.  1 TE  IN  STN  COOPD 
COMPONENT  OF  SATELLITE  IN  STN  COOPD 
COMPONENT  OF  SATELLITE  IN  STN  COORD 
NOT  US^D 

SECOND  of  OHSFPVATION 
NOT  USED 

run)  THRU  P(6«G) 


DFTFRM  I  NANT  Or  RF. 


Mflil)  THRU  M(A«6) 

SIG'"A5<r  RHO 
S  I  G*'A  r-  * ?  RHQ-DOT 
S  IG'R>  ~"3  AZIMUTH 
SICA'Ar  *3  ELEVATION 

K ( 1 , 1 )  THRU  K( 6  4  4  > 
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XT  ( 396 ) 

7(1  ) 

C  { ?97 ) 

Z(2> 

C(P90) 

7(3) 

CtFOOJ 

7(4  ) 

C (300 ) 

THRU 

C ( 340 ) 

C(341  ) 

THRU 

0 ( 37 6 ) 

0(377) 

C ( 370 ) 

C( 379) 

C(3Q0) 

C  ( 30 1  ) 

DXFST ( 1 ) 

C  ( 38?? ) 

DXFST ( ? > 

C ( 383 ) 

DXFS T { 3  > 

C (304 ) 

DXFST (4 ) 

0(38*5) 

DXFST (B) 

C(3B6> 

DXFST (0) 

C ( 307 ) 

THRU 

0(400) 

0(401 > 

THRU 

0(436) 

0(437) 

THRU 

0 ( 47P ) 

C (473 ) 

THRU 

C  <  BOO ) 

C  ( 50  1  ) 

ST  A  NR 

0(000) 

SATNR 

C ( 503 ) 

YFAR 

C  ( 504  ) 

DAY 

DFLTA  RHO 
DFLTA  PHO-DOT 
O^LTA  A7IMUTH 
DFLTA  FlEVATIOf! 

NOT  ush; 

PF(  1 « 1)  THRU  PF(6,M 


IT.Tlr/ATf  OF  X  F.'VRCP 
rC.TIVATF  O*  Y  K  PROP 
L  OT  I  MAT  f  OK  7  I:  PROP 

r st  i  MAfp  or  vx  rppof: 

rs TIM  ATF  OK  V Y  FfU ?OR 
F  ST  I  MAT  F  OK  V7  FRROP 
POT  Uf,FD 

PP (  1  «  1  )  THRU  f’P  (6*6) 
PHI ( 1 « 1 )  THRU  PHI (6*6) 
NOT  USFP 
f.TAT  I  ON  NUYOFP 
SATFLL.  ITf  NU!'.P~P 
YIIAR  OF  OBSERVATION 
DAY  OF  OnSKRVATION 


noooo  oonooo  •  <o  rt*r> 
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!  hc' TC  rAH: 


C  O’i'.’OM/A"  I T /£  C  600  >  '  fi 

O  l  mp.-t  I  or:  x  <  o ) « x^n  <  o )  <  0  <  606  > ,  >:rRR  ( 7s  > «  yfrp  < 7*5 ) « 

1  vxrw  (  7F  )  .  VY^ilPt  7  4  V/TPR  (  7E  )  ,T1MF(?F)  4  TP  1  (7*5>« 

?TP?  C  7*  )  4  JP-'i  (  7~. )  ,  rnr(  vn )  ,.T?>6  (  7*-*  >  »  TP7  (V<A),  7PB  ( 7^  }  4 
3TA|7«  )  4  Tc  (  7'»  )t4  T_I  <  ^  )  4  ?**PR  (  «0  )  f  TP2  f7fi  ) 

riryj i vAL^Krc  <r<onf>  «,t>  4  (rtool )  4X)  4  <c(  101  >  «xfr) , 
j  TM-'crp:  4  <  r<  v\\  1 4  ox;  or  1  j  4  (c(3np  >  *nxrr.Tp)  4 

P  (C(l?s.)  4  CM?  T/.  )  4  (  Ft  3‘Li  )  A'X-nro  )  4  <  CHIPS)  4  OXFST5 )  4 
3(0(4  n  1  > ;  .V1  1 ;  )  -  (  c  <  4  0  *  4  rpp  "• )  4  ( C  (  A 1  5  >  4  ?$r  2  3  < 

a  (c  (  a  or)  4  op.-  .*j  j ,  (t  <  ro)  4  pn:--*-;  > « tan  36)  *  pp  66  >4 

(-0  ( 7 1")  4  /•  )  4  ( i  A  7.  )  4 1  )  4  C  Cv?  7M  )  4  A  J  )  (  Cl  303  >  4  DXEET3  )  4 

6  (C  (7r»- .)  jOXSTr  i  «  C^.CAOP)  « PPO  |  tartC(4P4  )  «  PP64  ) 

7  ( C  ( 01  0)4  7.r  )  4  (  r  (  CO'-’ )  1  VO )  J 

'  r  Out-*  A  T  C  1  H  l'4  »-.X  4  1  4  Hr  Of  l.’K'&f  L 1  ST / Mfc  4  3X  «  7-5  IT'I  M*T  =  4^16.7/1 
r.o.o’-’A  r  1 1 5. 4  rx  4 1  r'?r:  l  r  •  7  j  / 

'V  ,*•  / 

i 

TCTR  IT.  A  TIP'  CO'.'NlFP  y 


T  TCTAv  =  0.0 
NT 

%)  CALL  7FP0 
CALL  INPUT 
CALL  FT AT 
CALL  roccxo 
4  CALL  FLE.VTS 
WRITE  (64601) 
WRITE  (6 46PO) 


1  I  if  (  1)  ,C(  1  +  ]  )  4C(  H?)  tT(  1  +3 )  tf.d'Vn  « 


I  C  (. HTj5)  4  C  (  I  +6  V  4.C  (  I  +  7  )  4  1  -  li  4704  0) 

•FOUNT"  f\  ' "  , 

KTCX  =  60 


NO  (“PRESENTS  THE  N’UMFCR.  OF  0F5SFRVAT  I-ONS  TO  FE 
REAp  IN.  NO  NO  If,  UFCn  TO  DETERMINE  WHEN  THERE  A*?E 
NO  MOP!"  MEASUREMENT  <C*  KTCK  DEPENDS  U^ON  THE 
■MEAS'JP'  MF NT.  INn*«VALS  OF  THE  RADAR  STATIONS 

MONO  =  (NO-l)tXTCK 

GO  TO  ?  r  ' 


IN-0  (A  PLANXCAPO)  IMPLIES  THAT  AN  OBSERVATION  IS 
AVAILABLE  ANo'^HIS  DATA  IS  Pr An, IN,  OTHERWISE 
INTEGRATION  OF  Tl-  EQUATIONS  0“  MOT  I  ON  CONTINUES 

e or  another  ti'*E  interval* 


READ  (S4*cOO)  IN 
(■  OOP  AT  ('ll) 

I  r  ( I  r  • )  a  4 1  T  4  a 

CALL  If  PUT  A 

Call  kalian 


•  / 
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DO  1 6  *  I  =  1 «  3 
J-  1  +  3 

XFp  (  I ) =X( I  )/AF 
16  X£R( J)=*( JJ/VO 
CALL  FLFVTS 
GALL  OU'P-TA 
CALL  TRAJ! 


.  THr  FOLLOW  1  NT  STATF  "NTS  TO  TI  (NT )=AI >  Af-T 

*’  USED  FCQ  Tr  V.PpUARY  STORAGE  OF  DAT/.  FOv'  US'" 

IN  TMF  PL OTT  1  NF  POUT  I':". 

S 

-  u 

’(  '  TIFF  (NT)  --  TC.TW 

JCTP  r  T Cl °  +  6.0 
XLR;V(  NT-  )  =  DXiT-.J  1 

Y5R«<  NT  )  =  DXFf.T  ?  .  •’ 

ZSRRC  lit  )  =  DXF.GT3 
VX~PPN(  NT  }  =  nx;rr-TA 
VYFRp  <  «  NT  j  -  DXFET5 
NT  )  =  DXTFT6 

■>"  -  TP1  (NT)  =  P^.l  1  . 

TP?  (NT)  =  PP?2  ' 

"  '  TP3 ( NT )  a  PP33  6 

A  TPA(NT)  =  P  PA/; 

TPS ( NT ) , -  PP^Q 
h.TP6  ( NT.)  =  PP66 
TP7 ( NT )  =«PP3t, 

TPfl(NT)  =  PP$'i 
TA(NT)  *  A 
TE  (NJT)  s  E’l 
T! (NT)  =  A I 
NT  =  NT  +  1  \  * 

WRITE  (64 601)  T 

WRITE  C6«*n6)  (hC(I)^(I  +  l)iC(I+?),f.(U3)tC(l+4) 

•  lCfI+5)  «C<  1+6)  «C(  147)  «  1  =  l«47?f3)  .  ..  *  . 

3  CALL  UPCOV 

CALL  TPAJ 

KOUNT=KOUMT+  1  ..  *  " 

IF  (KOUNT*LT*KTCK)  GO  TO  3 

*  KTCK  .c  KtCX  +  60 


THIS  STATEMENT  UPDATES  GREENWICH  SIDEfrFAL* 
T I MF  EVERY  MEASUREMENT  INTFPVAL 

,  TH^TA  =  4.TH-GRO  +s  0,00437E?6R>TCTR/60.0 

IF  ( KOUNT • LE • NONO )  GO  TO  1 . 

DO  17  T-h3 

.  © 

J=  I  +  3 

”XER( I )=X( 1 )/AE  ’  ; 

17  XER( J)=X( J)/VO 
CALL  Elf MTS  . 

CALL  OUTPTA  ,  -  9 
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*  1  » 
i  * 
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a 


O' 


*V  '*»  CALI.  PLOTS  <  D«  600  ) 

CALL  r»PAV.» ( XFPP ,  VP PP  » 7FRP •  XF l>R «  T  1  ’’E  t  NO  *3*3) 

CALL  DRAW  {  VXfPP.V'YFPP',  v7f:PP«VXfPP*T  IMF. NO* 3 .3) 
Call  draw  <  tp  i  «  tp;?  ♦  i  P3 ,  tp?  *  t  i  mf *  no «  a  «  a  > 

CALL  DP  Aw  ( TP  A  «  TPj  *  TP6 . TP3 .71  M.E « NO  *  4  4  A  ) 

15  CALL  OPAW  f  TA  ,  TF  *  T  j  «  TA » T  I  M.-  » N'0,t  3  «  1  ) 

CALL  PLOT F  -  .  , 

CO  TO  1  CC  ^ 

fl.'D 


y  »  . v  v  v  y  v  w  v  y  y  •<  *■  w  v  V 

AftAA(<AA'*  '  #  A  A  <.  /I  T»>'  ' 


«.  mrTC  Zr  PO. 

Sur.POuT  I  nf  ?rrri 
C 

C  Tills  SUPPOUT  !N\  V-'TS  THF,  COO  COMMON  STORAGE 

C  LOCAT I  ON'S  TO  ZFRQ  AMO  OFF  I  NFS  ALL  NFCFSSARY  CONSTANTS 

C 

COMMON/ AF IT/C (600) 

PF  AL.  MU  «  MUM  FT  ♦  UP  ,  J3  ♦  ML' 

FOUlVALFNCr  ‘  (C(?19,)«F1A  )  «  (  C  (  ??6  )  »F2F  )« 

J(C(?33)«F3C  ) 4 (0(017) . J?  ) « (C< 0 1 8  )  « J3  )« 

?(C(01F)*F  )  «  (CH(|iC)  *  AF  )  ♦  i  C  ( OOQji  ,  VO  )« 

3(C  ( 0 1  ?  J  *  MU  )  .  (  C  (  1|F9 )  «  TOOT  >.<CC016).KE  >. 

A  (C  (013)  «v:ir  ,)  «  (C(d03)  *DT  >  ♦  <C<019>  iMUMET  )« 

f.  <  C  (OJA)*  W I FP.  )  ♦  (C(OOB)  *DT?  )« 

6  CC(C07)«  0T3)  «  <C<  006)  «>*.'! EKE) 

NAMFL I ST/NAMFF/DT 
DO  1  I  -  1.600 
1  C(I)=-0. 

READ  {  F  «  NAMrS ) 

F  1  As  1  #0 
F?F=1 .0 
F36sl.O 
M.U=  1  .0 

J?~ 10PP.64FF— 00 
J3=-?«F46F-06 

F  =  i  •  o/por. •  ?5 

TOOT  =  0*  OF OS 3 A A 7 
M.UMFT  =  3*°n603pp+  1  * 

VIE  =  7.PPP1FE-F 

C  ••  • 

C  MULTIPLY  WIF  EJY  CANONICAL  TIME  UNIT  F OR  USE  IN 

C  SUFROUT  1  NT  FLF,j,FNTS» 

c 

V;iFKF  =  WlF**0S#P.1.364 
W!F?  =  V.'IP^^1F 
KF-4.360F430 
Ap=6370 160*0  .  • 

VO- 7.905376P40T 

0T?  =  0T-t-0T/F.0  - 

0T3  =  DTPV0T/3.0 


non  n  n  n  n 


GGC/EK/70-7 


/ 


RETURN 

END 


* 


»******•»  «*-K  **  S  «  >  tf-  -S-  -K  -if  -S-y-rr  it  *•"  **•-* 


SlHETC  INPUTZ 

SUBPOUT  1 NE  INPUT 


C 

C 

C 

C 

C 


THIS  SUBROUTINE  READS  IN  THE  El  PST  S^i  T  Of*  DATA 
WHICH  IS  Lr.cT  IN  SLT'POu'l  I NE  fOf.Ovp  TO  ESTABLISH 
INITIAL  NOMINAL  TPA  Jr CTO'-'Y 

COMMON/ AE I T/C ( 600 1 
PEAL  L AT  * LONG « M I NU T E 

INTEGER  SATMP  «  STAND  « YEAR  4  DAY 4  HOUR  " 

EQUIVALENCE  (C( 001 >«T  )  4  (  C  ( 003 ) 4 DT  >4 

1  CC  (  l?r.).»HT  )  «  CC(  126)  «LAT  )  *  (  C <  1  PA  ) « THE TA  )♦ 

2(C(0S/|  )  *EL  >♦ <C(053> »A7  )  4  (  C  (05.1  >  4  Rl-lO  )• 

3  ( C  (  06  1  )  ♦  ADOT  )  4  (  C  (  062  )  <  EDOT  )  »  (  C  (  34  1  >  » PI  1  )• 


4  (C  (3SS)  «P33  )  *  CC(3GP>  «P44  )  4  <C <  360  >  «  P55  )« 

5<C(26G)«P1  ) « (0(267) ,PP  >«(C(760)«P3  )♦ 

6(0(501 ) 4  STAMP  ) « (C(502> 4 SATNP  ) 4 ( C ( 503 ) 4 YEAP  )« 

7(C(02O)  «  HOUR  ) «  ( C  ( 030 ) 4  MINUTE) » (fc( 1 67 > 4  SECOND ) • 
OCC(OpS)  4  ED)  4  ( C  <  026  )  4  AH  )  4  (C( 027) 4  PH)  4  (C(0?P.)  4PDB)  4 
9  <C  ( 127)  4 LONG  )  4  (  C  ( 052  )  4 PHCDOT)  1  (C(  ?.4 0  )  t  P22  >4 

A(C  (376?J  ,P66  I  4  (0<7t,v>  *W4  )  4  ( C  (  504  )  4  DAY  >4 

6 ( C ( 1 23 ) 4  THEGOO )  4  (  C  ( 020  5  4  T I  )4(CfD3?>4NO  ) 

NAMEL  I  ST/NAME  1/F.H  4  AD*  RE  4 PDH/NAMr2/P  1  1  4  P22  4  P33  4  P44  4 
1  P55  4  PG6/NAME3/P 1  4  P2  4  P3  4  P<5  /NAV.E6/HR  4  P I  NUT  4  SEC  iNO.TI 
PFAD  (5*  NAMED 

READ  (5 « NAMES)  4 

READ  (54  NAMES) 

.'I 

RL  THROUGH  R/»  (COMPUTED  DELOW)  APE  EQUAL  TO  THE 
SIGMAS  SOUAPtCD. 

ll 

R1  ~  Rl**2 
"  R 2  =  R2**2 

R3  *  ( R3/57  4  3 )  **2 
R4  c  (  R4/57  #  3 )  **2 


READ (54  NAME6 ) 


.  WRITE (64 NAME6) 

READ  (54501  )  LAT 4 LONG 4 HT 

READ  ( 5 4  502  )_  SATNR  4  STANP 4  YE AR  4 DAY  4  HOUR  4  M I NUTE  4  SECOND 1 
1  E‘ L  4  AZ  4  PHO  4  1 NDEX  4  RHODOT  4  EDOT  4  ADOT 
1  I NDEX  4  RHODOT  4  EDOT  4  ADOT 


THETA  IS  THE  MEAN  SIDEREAL  TIME  AT  GPEENV/ICH. 

•*> 

.RHR  =  HOUR 

THETA= ( HP+PHR  +  (  P I NUT+M I NUTr ) /60 . 0+ ( SEC+SECOND ) / 
1 3600*0) * 15#0 
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\>’rn  Min  i„ 


4 

.  / 


. . . •.iniiaMMf, 


non  n  n n 


f 
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convert  thct a  rPO*i  rrerf-rc,  to  pah i ant-* 

THP'TA  -  THFTA*  1  «  7A533cO*r—? 

THFGBO  =  THFTA 
HOUR  =  RHP 

GO  TO  (  1  «?*3.A  )  «  !NPrX 
1  RHO  =  WHOM  0*0 

GO  TO  100 

?  PHO  -  nHcnoo»p 

CO  TO  100 

3  RHO  =  RHO* 1  GOO. C 

GO  TO  1  on 

A  RHO  =  PHO* 1 0000.0 

100  WR1TF  (6*000)  fAtmr  *  STANR*  YF AP  «  DAY « HOUR  *  M I  NUT^  • 
BSFCOMP* 

1 L  AT  ♦  THFTA  *  LONG .  HT  ,  FL  «  A 7 « PHO  *  P.HOOOT  « FOOT  «  AOOT  *  T  «  OT 
501  FORMAT  '(  AM  «  F7 »  /l  «  F °  »  A  *  F6  *  0  ) 

50?  FORMAT  < IX* 15. !?* I?« 1 3* 1 ? *F? . O « F5. 3 *F6. A « 1 X«F7. A « IX* 

1 F7*  ? .  1  1  «  1X*F7.?»  1X.F5.4*  1X«F^#A  ) 

600  FORMAT* 1  HI *3?X.33'MNPUT  PATA  FOR  INITIAL  TRAJECTORY/ 
130X*  lOHS/  Tr  LLIT?  fUMi'FP  =  *'  1 5*  !  OX « 

B 1  7HST  AT  I  ON  NUMf’.FR  =  t 

?  I  3/A3X  «  AHYF AR  *  f  X  ♦  '•I- PAY «  5X  «  4HHOUP  «  5X . 6HM I  N'UTF *  FX « 
36)^CONO/AA X  «  ,1  ?♦  6X  *  1 3.  OX »  !  ?%  5X  «  I  ?  1 7X .  F6*  3// 

P3X*  1  IHl.ATITOPF  -  ,  F 1 5.7.5X*  1  OMTHFTA-e-  =  ♦C*)5.7«5X. 
A1PHL0NGITUP"  =  « F 1 5 • 7 * 5X « 1 7HST AT  I  ON  HEIGHT  =  «F6.0/3X 
51  ?Hf  LFVAT.  1  ON'  r  « «=•  1  5  •  7  ,  A  X  «  1 0HA7 1  MUTH  =  *Fjl5.R«5X* 
66HRH0  =  *F1  5.7,  1  IX*  lOH^HO-POT  «  «F15.7/:yx» 

A  1 7HFLFVAT I  ON  B\Tr  =  «F15,7*?9X« 

7I5HA7IMUTH  RATF  «  « F 1 5. 7//3X « 1 6HST ART  I NG  TIME  =  • 
BFA.P/3X*  ?AH  INTEGRATION  STF'9  5 1 7V  =  *F4.2> 

STATION  BIAS  CORRECTION. 

i 

FL  =  FL  +  Ff3  ,\ 

A2  =  A 7.  A3 
PHO  =  RHO  +  RR 
RHODOT  e  RROOOT  +  FOR 

RETURN  V* 

ENO 

******  x  r  x  x  x  *  *  -r  *  *  *  *  *  -x  *  *  *  *  *  *  *  *** 

\ 

\ 

MBrTC  I  NnUTR  '-H 

SUBPOUT  I  Nf"  INPUT  A 
C 

C  TIIS  SUBROUTINE  W fiO S  !N  ALL  MEASUREMENTS  \ 

C  SUBSEQUENT  TO  THE  FIRST  MEASUREMENT 

C 

COVMON/AE l j /C ( 600  * 

EQUIVALENT-  <C<  51)«PH0  )«(C(  ^BJ.RHOOOT)* 
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non 


/ 
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1  C  C  <  053 )  «  A7  )*(C(  F4)«'fL  >«<C<  61)*A7DOT  )* 

p(C( c>?* > * fp )  *  ( r  < opf  ) «  ap > * ( c  { o?7 )  *  rb ) « <  r  ( > * rb. u  * 

3  ( C  ( 062  )  « C'L HOT  ) 

RFADt  n«S00H:L*/‘*7«r-'i  lO*  I  \rf'X4i?MOrOT  ♦"LOOT 
SCO  FORMAT  (73X^6.':  «*1X«"7»4  «  1  X  *'  7*?<  J  ]  t  1  V«r~/«r>,  lv,rc-„A  ) 
GO  TO  (  1  *  7  «  3  *  4  )  ♦  1  \,r>?~X 
1  RHO  =  RHO-V 10.0 

GO  TO  100 

p  RHO  =  RHO X 1 00  * O 

GO  TO  100 

3  RHO  =  PHO* 1000.0 

GO  TO  100 

4  RHO  =  PHh”100OO,n 

STATION  KlAS  CORPf* C T 1  ON • 

100  F L  =  FL  +  FB 
A7  “  AZ  +  A3 
RHO  =  RHO  +  PR 
RHODOT  =  PHODOT  +  PDP 
RFTURN 
END 


*  *  *  *  *  x  x  *  *  *  «  -x-  *  *  x  *  -x-  -x  x  -x  *  x-  -x  x  x *  *- x  x  * 

5.IBFTC  O’JTRTZ 

SUBROUTINE  OUTPTA 

*  i 

C  ^ 

C  THIS  SUBPOUT  IN"  WRITES  THF  CUPRrNT  VALUES  0.ir 

C  THE  POSITION  AND  VFLOC I  TV  Of'  TH"  SATELLITE 

C  ALONG  WITH  ITS  ORBITAL  FLFMrMTS 

C 

COMMON/AF I T/C ( 600  r 
EOUIVALFNCF  CC<020)«TI> 
cl i  >=c( n-Ti 

WRITE  ( 6*600  )  CC  1)  *  C(  128  )  *C<  124  )  *C(  1  76)  «  CC  177)  ,C("4  )  « 
1 C  ( f5 1  )  *  C  (62 )  *  C  (  S3  1  »C(ri?)  »C(61  ) 

C ( 1 ) =C ( 1 )+T  I 

WRITE  (6*601)  C( 1 ) *C(91 > *C( 101 ) *C(94 ) ,C( 104 ) *C<9?) * 

3G ( 1  Op ) C  <  95 ) « 

1C( 105) *C(93)*C( 103) *C(96) «C( 106) *C(97) ,C(9p ) ,0(51  >  * 

PC  (5P>  *C(93)*C(KA)  ,C  (36)  *C(37)  ,0(^3)  *0(9.9)’ 

V/RITE  (6*602)  C(  1  >  «C(71  ) «C(72) *r(7S) «C(79> *C(O0) » 

1 C  (  74  )  *C  ( 75 )  *  C  ( 73  ) 

600  FORMAT (  1  HI  «4X*  1  OH  INPUT  DATA « 5X* 7HT I  v,F  =  *FJ5*7//56X» 

1 1BHSTATI0N  PARAMFTFRS/BX«0HHFIGHT  =  «F13.7«5X* 
78HTHETA  =  «F15.7* 

P5X«.l  1HLATITUDE  =  ,  F 1 3  •  7  «  ^X «  1  7HL0NG  I  TUDF  =  *  E  1  ^  .  ~r//3tX 
318HRADAR  OBSERVATIONS/ 18X* 1PHELF V AT  I  ON  =  «E)5.7*5X* 

4  1  4HSLANT  RANGF  =  •  F 1  *S#7,  1  OX*  1  7H"LFVAT  I  ON  RATF  =  ,« 

BE  IB* 7/1 9X. 

510HA7IVUTH  =  ,^16-7«7X« 1PHSLANT  RANGE  RATE  =  *r13.7* 


s* 


o  r> 


•  ;** 
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65X,  15HAZ  1  V'.JTM  PATi  =  ,F15.7///) 

601  FORMAT  (4X,  1  lM'UTRVjT  HAT  A  «  5X  .  7MT  1  M£  =  «  F  1 5  •  7//4f'X « 

1  31  H.7AT  FLL  ITF  POO  IT  ION  AMO  VfLOC  1  TV//7X  « 

77MV(M)  ::  «!“1  A.7«0X,PHX(«-P)  "  4515.74^X4 

3iohvx(m/f>  =  ,f'i/\,7«^x«7Hvx(ru)  ~  iri'itl/p.y * 

47MY(M)  =  «ri  oy,  PHY  (TAM  “  ,515. 7, MX, 

‘"'l  O'IVY  <  M/<\)  -  »c‘lP.7«PX,OHV,Y(Ftl)  =  4f_15.7/7X4 

67H7 ( ri )  =  •rir*.7,‘s>:,OH7(rm  -  ,r  io.t.'-x, 

7  1  OHV  7  (  M/5 )  =  «'15.74r5X47MV7<FU)  =  4  ~  1  5  .7/5X  «  7HQ  (  M, )  = 

rr 15.7,77X4 

flr>HV(M/5>  -  ,1*15.7/  0X4  01(71)0-:'.  -  ,fi5.7,4X4 
Cl^IP10-D0T-r/.\=  4c1r'»74 

9ix, 7ha7/**?'  =  4r.!0*'7  40x,7MrL~:i  -  ,515.7/  ox.^mpho-c  =  , 
nr  15.7,4x4 

Al  PHPHO-DOT-C  -  ,F1  0.7,  1X,7HAZ-C  =  ,  F  1  9  •  4  OX  ,  7MFL-C  -- 
m 5.7///) 

607  FORMAT  (4X  4  lOPOP.  ’.jTAL  FLF Mr  NTS ,  OX  4  7HT  I  MF'  -  4F  1  5.  7//5X, 
•  .74  HA  =  4TIF.7, 

15X4Ati«-rr.  =  4 ,r  1 5 .  7  ,  5X  4  4  H 1  -  «ri9..7,5X,5HLN  -  4r"l5.74 

4  5MAf*  -  4 

?n  5.7/ox,  /,H  -  ,F1  r..7,5X,4HM  4  F !  5  ..*7«  7X  4  7HF7T  =  4' 

5515.7) 
nrTur.w 


X-  y.  **  v  y.  V  V  v  m.  V*  V  v  V  Sf  v  v  /  «•  w  v  v  •*  »>  •*  v  y  w  «•  <•  > 

ff.IHFTC  COV. 

7U5P0'JT  1  Nf  UnCOV 

r 

C  TH15  f.UPPONT  INF  U^DATFF  THF  rPROR  COVAR  1  ANCF  V  ATP  IX 

r.7  UOf  OF  TMr-‘  5TATF  TRAM7! T I  ON  MATRIX 

C0'7'0'.'/AF1T/C(600l 

Olf.FK'AIOW  r-P(6.6)  .Pr(6*6)  4 F  (6,6)  4 PAD66 ( 6» 6 >  4.PHI  (6.6)  * 
1PAH661 (646) 4°HIT(6,6>  ,  , 

FOUIVALFN'C1  (0(701  >,F  >4(0(270)  40  >4 

1(0(74  1)4^0  )  4  (0(401  )  ,PP  1  4  ( C  ( 007  >  *0T  >4 

7  (  C.  (POO)  4  DTP  )  4  (C(O07>  ,nT7  )  ,  ( C  (  477  )  4  PM  1  ) 

C 

C  CO^PUTF  THC  7Y7TF.Y  PC  OOP  I PT  I  ON  MATRIX  -  F 

r  .  •  ’■  - 

CALL  F-nV 

C  ^ - 

C  C  0‘>'r’UTF  5TATF  TRANSITION  MATRIX  -  PHI  AND  PM  IT 

C 

CALL  r'RPp  (  R  ,r’  «  DAF’66  46464O4O46) 

CALL  MRRD(- , R/ 765 , PAD66 1 46164O1O46) 

DO  11  1-1 46 

DO  10  J=1 46 

10  PMI  (  I  4  J>-F(  I  4  J)'0T-i-PAD66(  1  4  J  ) -T-T7+PAOO>61  (  I  ,  J)*DT? 

1  1  -RM1  (  I  4  T  >WoMI  (  !  .  I  1  .0 


\  ■{> 


1 1 


o  o  o 
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CALI.  MTRA  (PHI  ,PH  IT  *6*6  «n) 

UPDATT  FILTFP  FSTiMATIOW  COVAP  I  AWFf  ’  '.ATP  I  / 


-  PL 


CALL  f'.PPD  (PHI  ,PP,PADW(6iAiO<r.tA) 
C?ALL  PPPH  (">ADA,(>«PHIT«P5-t6*6<P«0*M 
n  =  DFT ( PF  46) 

DO  73  !  -  1  »  0 
DO  33  J=1 *6 
23  PP( I  * J)-Pr(  1  4 
RETURN 
F  MO 

y  v  w  y  **  y,  v  v  v  .>  «<  v  w  v  •>  w  •  •»  v  «•  *- 

/.  }  t  >  r%  *t  r.  .  4.  **  ri  t%  t'  n  *  r  r  *  ' I  r  •  A  I  i  't% 


ff.II7.FTC  EOCOK* 

sup-pout  l  n-  ror.o-.v5 

c 
c 
c 
c 
c 


THIS  SUBROUTINE  WMFN  Gly-U  RADAR  YF  A  f  U  R  F M F  N  T .3 
COMPUTES  V A LUFF  FOP  POSITION'  A\T>  VELOCITY  OF  THF 
SATFLL1TF-  IW  T  I  f  POT  AT  IN'S  GFOriMTHlC  FPA‘'F 

COMMOM/AF I T/C ( 600 ) 

REAL  LXH,l.YK'«L7R*L  xnP«LYDP«L  2DH*L  1  *  L7  «  L3«  :<F  «  L  OK‘0 ,  LOK'Cr. 


EQUl VALENCE  ( C ( 033 ) «  A 

I  (C(0M  )  «P»fO  )  «  (0(061  >  i  ADO" 
2(C(0B2>  4RH000T) 4  <C( I  26 ) 4  PH I 
3  ( C  (  1 28 )  4  Hf  I  GHT )  4  <  C  (  1  3 1  )  4  C.X 


)  4  (C(  101  >  .f?X 
)  4  (C(  10AMPXD 
)  4  (  C  ( 0 1  Or  4  AF 
)  4  (C(0°1  )  iXVF.R 
)  4  (  ciooa  >  4  p 

1  4  (C( 137) (XSMR 


A ( C  ( 1 33 ) 4  C7 
6 (C ( 103) 4R7 
7(C (106) 4P7D 

8  ( C (179) 4  TDOT 

9  ( C  ( 093 )  4 2tA~.fi 
A  (C  (0«6  )  4  7DMFP 
B (C ( 1 39 ) 4  ZSM 

DATA  CDTP/1  . 74^3293^-2/ 

PHIR=PH!*CDTP 

AR=A*CDTR 

ER=E*CDTR 

LONGR  =  LOMG*CDTR 

SG  =  SI N( LONGR I 

CG  =  COSCLOMGR) 

SP=SIN(PHIR)  * 

CPs COS ( PHI R) 

SE=SINCER> 

CEsCOS(FR) 

SA=SIN(AR> 

CA=COS( AR> 

RHOF  ~  RHO/AF 
RHOD  =  RHODOT/VO 

ed=edot*go*o/kf 

AD=A007*60.0/K»-  ' 


f 4  (0(0^4  )  iF 
) 4 ( C (  062  )  4  FOOT 
>  4  ( C ( 1 77)4  LONG ) 4 
)  4 (C( 1 72) 4  0Y 
) 4 (C( 102 ) 4PV 
) « (C( IFF)  4°VP 
1  •  (C(016)  4lTF 
)  »  (C(D~7  )  4 Yf 
)  1  (C(0"e5)  4VOM"  R 
)  4  (C(  1  ■*">  i  vr-r.tr: 


)  4 
) « 


)  4  (0(013)  4,r)  4  (C(p)  4  VO)  «  (C(  13)  4 


)  4 
)  4 
)  4 
)  4 
)  4 
)  4 
)  4 

v:f  >  4 


107 


■■  i-  .. «... 


n  o  o  o  o  r>  o  nnnn  o  n  n  non  non 
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a.pcf  =  ap 

h=mf icmt/a*  ..  • 

crr  =  !,o/rnTn.o-(,0.nvr-rrniT,px<;P) 

S*SFF a  (  1 .0-F)  S-:  p  '■ 

-  .  '  * 

COMf,UTP  COOPPlNATrS  OF  .STATION  IN  ROTATING  FRAME 

cv  -  -(rrf  +H)  <rr.?cr 
CY  -  -(^rri!')?CP>r,r, 

C7  ---  ~<S+M)"Gr> 

XrMR  sr  r.X'AP 

Y'ap  '=  rv:  A»L 
7C‘1  «  C7'\: 

CO’  (  UTf  V'r.TOR  L  IN  ROTATING  FRAMF 

pn 0  1. 1  -  F: ’•* Cfy“ C.A 

LT-Cr'  V  SF 

L7-cr>r.A'  <■ 

lxp  =  CG*<-i.i+t?>  -  SG't.3 
LYP  =  SOr<-Ll+l  P)  +  cr,“!.7 
L  7P  ~  rn-SC.f  J-CA-I  Rf*y  re 

COMPUTE  VrCTOP  1.-POT  in  rotating  FPA *'F 

“  CGr?PV^Ar-APCF  +  CC»* SP-»f,F* CA*F.n  +  C6* CP *CF*rP 

I  ~«c;cu  'CA*A\Pf‘r  +  SO EGA"  TF  "FP 

LYn'-'  =  S G •“  Sr> * S A. ’  A PG p  4  sc.*GP*SFXfA*Fr>  +  SG*CP*CF#FR 
I  »  fr<  ca,  ?>  a.ptf  -  cc^  sr- *  sa^fp 

L/r>R  *<-CR  >  f>A  S  ADC'-  ~ CPS CA*  SF*f  O  +SP*CP  *FD 

COMMUTE  COORDINATES  Or  0”J:  CT  WITH  RFSP7CT  TO  ROTATING 
SYSTEM  ' 

PX  =  miOFSt.XR  -  CY.  '■  • 

RY  “  PHO'N.YP  -  CV 
P7  =  RHOrU  7P  -  C.7 

*  ’  d  <t  c  ,  ‘ 

•'  COv*r’UTF  vrLOCITY  nF  O^JFCT  WITH  RESECT  TO  ROTATING 
•  system  •  • ■  *  '■  • 

RxO  RHO/  »LXnR  +  RHOP^LXR 
RYO  -  RHOprLYPR  +  RHOP“LYR 
P7P  =  PHO~“  l  7PP  +  RH0f5«  L7P 
CONVERT  FRO*-'  FA  PTH  UN  I  T  S  TO  MFTPRS 
XVFP  r  PX-A17  - 

7N_P  =  PY  f-  A5* 

7M~  r>  =  P 7  -  /■ r  n 

'  “  C 

CONVERT  rPOv  PART1 1  UNITS  TO  MFT.FPS/5FC 


Xpvp  =  rxP.KV'O 


■  o*  #  . 


non  n  n  n  n 


<? 
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YOMFR  =  RYP'- VO 
7DMFP  =  P7D*VO 
RETURN 
FND 


3.IBFT0  FLFV.T.l 

SUBROUTINE  FrLF'-'Tl 
C 

C  TH I S  SUBROUTINE  WH^N  GIVEN  TH:r  rr:uATOEIAL  COMPONENTS 

C  X,  Y«  7  4  XD4  YD  4  70 

C  COMPUTES  THF  ORBITAL.  FL.F  v.FNTS  - 

C  A  4  FCC »  T ,  It  ALM«  AN,  <“  4  M 

c  unit  vrCTCP=;-p,o«v-  ape  utd 

C 

COMMON  /AFIT/  C(600) 

Rf^AL  1«V,U/M«XF  \  a,  *  f 


FOU I VALFNCF 

(f(l.Ol)fX 

)  4  (  0  {  1#7  )  4  Y 

)  « 

1  (C  (  103)  %7 

)  4 ( c( ioa ) 4xn 

)  4  (C  (-103  >4  YD 

)  « 

2(0 ( 106) »7D< 

) « (C( 071)4  A 

) 4 (0(077) 4 ECO 

)  4 

3  ( C  ( 073 ) «  T 

) 4 ( 0 ( 07 A ) 4  E 

)  4  (C(qV5)  «M  •. 

)  4 

A  (C  (Ol  6  )  ♦X’V 

>  *  <  Cini  2 »  .?im 

\  t  f  n  (  \  9  nrn 

)  4 

F  ( C  ( 077  > ,pno 

>4,(0(070.)  «  ANGI 

)  4  (CCOVO.^AVGALN)  4 

6(C(0S0) «  ANGAP 

)  «  (0(0P1  )  iR.X 

) 4 (0(037) 4°Y% 

)  ♦ 

7(0(003) « P7 

) 4 ( 0 ( 034 ) « nv  o 

) 4 (C (003) ,0v 

)  « 

fi(C(0OG)4O7 

)  4  (C(0B7 >  4V;X  .  , 

) '4  (O(O^P)  4V.'Y 

)• 

9  ( 0  ( 0^9  >  « WZ 

)  4  (0(070)  4  E-FR 

) 4 (0 ( 174 ) 4 THF OR 

A (C ( 006 ) 4W1FXF 

>  4  (0(004  )  4  s r/r/u) 

4(0 (010)4 AF 

)  « 

B (C (031 ) «HP 

> 

* 

DATA  CRTD/S7 #705700/ 

TRANSFER  X « Y « 7 «XD . YD« 7D»  FROM .ROTATING  FRAME  TO 
INERTIAL  FRAME 

ST  *  SIN(THFGR)  y‘ 

CT  =  COS(THFGR) 

XI  =  X*CT  -  Y*ST 

Y I  =  X*ST  +  Y*CT 

XDI  =  XO*CT  -  YD*ST  -  WIFKF*YI 

YDI  =  XD*ST  +  YD*CT  +  V'!Fk:F*XI 

X  =  X I 

Y  =  Y I 

XO  -  XDI 

YO  =  YDI 


COMPUTE  THF  SEMI -MAJOR  AXIS  -  A 

‘<10  RO  =  SORT  ( X*X  +  Y*Y  +  7*7) 

\  •  VSO=XO*XD+,YD*YO+ZO*ZD 
SORMU=  SORT ( MU ) 

ARFC= (7./R0 )-(V3 O/MU) 


o  o  o  o  o  .  p  o  o  •>  o  o  p  r  p  p  o  p 


GGC/EE/70-7 


f 


V  : 


c 

c 

c 


c 

c 

c 


A  =  1  .P/APFC 

* 

COVPUTF  TH-  PFPIPP 

H 

P FO? - ? H  3 1 P  V A  *  F OP  T  (  A  X  r  P/MU )  /  KF 

o  =  a y ( i ,p~rcr > 

HP  B  AFHO-l.Ol 

COf.-P'JTf  TH'-  ICO  N7P  1C  11  Y  -  FC C 

t 

OO^  r/r.'i-Ui'  (  (  1  .  /PO  J  -  APFTC  ) 

Qp-FOPTt V^O  ) 

n  x  n  •? v  -:t  y-)+7!7m  /  r,oo;  *  -j 

kc=po  pr>/ro'-vu 
r  r»=n/roPT  <  a  ) 
rcr.=  fc.ft  c ?*c  x .  p*-rc  ■  •-  p n 


F 


X- 


CO’-'PUTr  Tl  *K  FCrr\’TPIC  ANOMALY  -  F 

r  =  ATA?jptrr>« r  c> 


CO  'i'UTt  TH!  f-'l  AM  ANOMALY'  -  M 

•McF-rs 

COYPUTr  Tfir  fPDCH  T I MF  -  T 

t  sn  x  f  opt  (  a  x  «.n  >  /  c  r.pr;Mjr:‘<r  > 

a*’ 

COK^UTr  TH-  CO^PONF NT?.  0~  P 

*  » 

« 

A  X  =  ( OP  ‘  X-P  x  X O )  /SOP MU 
A Y=  (OP'-'Y-P*  YP)  /n^L’M'J 
A  X r  (PP -  7-0-  7  ■>)  /SOf.’MU 

px=ax/fcc 
py-ay/^cc 
P7=  A7/rCC 

.COMPUTE  THP  COVPO'TNTF  OF  0 


SPr  a  -  ( i  .-rrorcc.  > 

Hspp-ro 

Mp-S0PY'jrp/PO  t 

PXr  (  HP  V  X-H  -  XP  )  /SO F"'J 

H  Y  =  (  HP  S-  Y-H  V  Y  P  )  / s O ~ MU 

H7b  (nn?7-H*t7P)  /f.r.-OMj 

onr  i  •  n/(f:cr  *50RT  (  c-p>  ) 

ox=r»x*on 

OYrHY  NT.’P 
07-'*  X-.-  OP 

roM~v~f  th*  rovpp*>-.vT5f  o-  vr 


!  no 

i 

i 

i 


(  .  o .  .  ^  ^ 

,  ^  t  ^  1  *  **-  j 

\i ^ Lint+umatllhBaaM aatttffciia - -  i 


>> 


7 


i 


./ 
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c 


HX=  (  Y*7r>-Z*YD>/SCPMU 

hy=  <z*XD-x*7n)/sonMU 

H7=  (  X*  YD- Y*XD  )//r-.nwj' 

t.opt  ( '"r) ) 

wx=HX/sorp 


V,i  Y  =  R Y/SP  Sfj1 


W7=HZ/SPrP 


/ 


C 

C 

C 


covr^uiE  th'  Ar:rt.r.s  -  ]»  alw«  Apy 


i.  i 


I=APrOS(V7>. 

ALN'-ATAW?  (  MX  *  ) 

AP-ATAKP(P7«0X) 

ANHi-r^cnTi) 

l f  <  ang i  •(  r.  o *q  i  am-  |  r /.Mr- 1  +360 « n 
ANGALW-AJ  K';:cmr'. 

I  F  (  A^GALN  •  t  T  .  O .  0  )  A  MG  '•L\*  -  A  PC  AL 1 !+P6  0  .  0 
A  M  G  A  P  =  A  P  rffi  T  D 

I  F  ( ANGAP.L T  •  0  •  O )  AM  G  A  ^  -  AUG  A 360 •  O’ 
GDO=QX*OX-4  0Y*C?Y*(V**07 
ODP=OX--*PX+OY  “PYH  !v?-SP7 
RETURN  V  * 

END 


*  »**  x  ■:?  r 


.V  W  u  y  v  y  ♦,  y  V  V  I 

/•  «  M  f",  ^  #**•**,/> 


ftinrrc  EL  FM.T  •  ? 

suMPoyfiNr 


\ 


c 

c 

c 

c 

c 

c 

c 


ELFMT?  , 

THIS  SUP- POUT- IN'-  WHEN  GIVEN  THE 
^X,  Y,  y.i  XD  «  YD «  ZD 
COMPUTES  THE  ORBITAL  ELEMENTS 
A«  FCC,  T «  1  1  «  ALN«  AN. 
UN]T  VFCTOPS.-U.V4'',7  APE  USED 


FOUATOrriAL  COMPONENTS 


F,  M 


O. 


COM.MON/AF  1  T/C  (  600  I 


REAL  |»MU«M»KF 
EO'J  I  VALENCE 
1 (C < 103) »7 
P(C  ( 106) «7D 
3 (C ( 073 ) «T 

4<C  (016)  «KE 

5 (c ( 077 ) « uny 

6(C (080) « ANGAP 
7 (C (083) «UZ 
BtC (086) «VZ 
9<C(03O)*WZ  .  v 
A  (C  (006)  «V.'1FKE 
B ( C  <  03 1 ) «  HP 


<C< 101 >  «X 
)« <C< 104 ) «XO 
) « < C ( 07 1 ) , A 
) « ( C( 074 ) «E 

)« (C(oip)  «riu 
) tic (078) « ANG  I 
)  « ( C ( 031  ) *UX 
) «  <C<084 ) « VX 
•  }  ,  (,C  (  097  )  «V/X 
)  «  (C.I070)  ♦  Pr7P 


( C  (  1 02 ) «  Y 

c 


C  C  < 1 03  >  » VD 
(C(07?> ,^CC 
(C(p7<=)  «M 
(  C  ( 076  )  «urvj 

CCC079) , AN6ALN 
(C(f)ap  j  tUy 
( C ( 083 ) ♦ VY 
( C ( OPP ) « WY 
(rWJ>A)»THFSR 


> « < 
1 


( 004  )  «  SOP  MU  )  «  (  c.  ( 0  1  o  )  .  AE 


y> 


DATA 


CRTP/37 • 293700/ 

j  5  ’ 

\ 


.  6 


111 


1 


o  n  n  non  non 
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c  Tp.'N.'srrtt  x«Y«7*xr>. yo*zp*  from  rotating  fra^f  to 

C  INERTIAL  R.’A r.r 

C 


CT 

=  eOS(TH^GP) 

ST 

=  S  I (  Tl  IFOR ) 

X! 

=  X  “  CT  -  Y~.r  T 

Y! 

=  XvST  +  Y "CT 

xm 

=  yO'C"  -  YOrST 

-  V'lFKE-YI 

YOI 

=•  XO  ’.-ST  +  YOtr.T 

+  viricr-xi 

X  =  XI 
Y  =  YI 
xo  =  xr>i 
YD  =  YD  I 

10  PO  =  SOPTiXX  +  Y-Y  +  7*7) 
Sopvu-go7T(:’U) 
lx  =  Y--«  70-7 -YO 
MY  =  7*X0-XX70 

H7  =  X'YP-YIiXO 
P  =  HX*HX+I-!Y  “  Mv+M/£  r  7 
PS  OP  =  SOOT(P) 

V'X  =  HX/PSOP 

V'Y  =  HY/PSOR 

V'7  =  H7/P?OR 

UX  =  X/PO 

UY  =  Y/PO 

U7  =  7/PO 

VX  =  V.’Yv  U7-Vj’7  JY 

VY  =  V,7*UX-V-,X*M7 

V7  -  V'X  -  L* Y — V;  Y  < JX 

Ro  =  ( x  f  yn+Y » vr'+z « 7f ?  >  /po 

FSV  =  PP*PSOP 

FCV  =  (P/P0)-1.0 

CO’^UTF  THr  FCCFNTP I  C.  I  TY  -  FCC 
FCC  =  SGPT(FSVy*P^C  **2) 

COMPUTE  THE  SEMI-V.AJOP  AXIS  -  A 


A  =  P/{ 1 •o-ecc*s?> 
o  =  A«-u.o-rco 
HP  =  AE*(C-U0> 


CO"nUTF  TH-  DFPIOO 


IP  PpP  =- 6  •  PP  7 1  n'jA  *  FOP  T  (  A  ”  *  .7  /MU  >  /KE 
Ay  -  UX  * E C V” VX>E SV 
AY  =  UYv-FCV-VYSESV 
A7  =  U7T  rCV“V7”crSV 
SV7  =  SORT (  1  •0-,*,7  -  *2) 

AXN  =  (  -AXTV/Y+A  YF-.'X  I  /.S  *'7 

AYS'  -  (  (  <  /-yrwx  +  AYiV'Y  >  )  /E'7 )  +A7*  Svf7 


n  nn 
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C 

c 

c 

c 

c 

c 

c 

c 

c 


COMPUTE  THr  ECCENTRIC  ANOMALY  -  F 

FS^  -  (  ( PO^ft'r  'T  <  1  .p-ECC* ■*■?. )  )  -rrsv  )  /n 
FCF  =  CECV+FCCr-v-?>/(  1.01FCV) 

F  =  AT  AN?  ( T  Sr  *rC'~  ) 

COMMUTE  TH-  ME  AN  ANOMALY  *v  V 

M  =  F-FSF 

COMMUTE  TIE  FPOCH  T1VF  -  T 

T  =  M  OOP  T  <  A  r  *  3  )  /  <  °  OR  v-j  ?  ^  r  ) 

COMPUTE  THE  AMGL*:  S  -  I*  ALN «  Ap 

I=ARCOS(W?> 

ALN’=  AT  AN?  ( V/X «  -NY  )  # 

AP  a  AT  AN? ( A  YN • AXN J 
ANG1  = I “CPTH 

I F  (  AN'G  I  *LT  *0.0)  ANA  I  - ANG  1+300.0 
ANGALM= ALN* CPTD 

1 F  ( ANG ALK'.LT  .  O  .  0  )  A  NGALM -  ANGAl  N+  360 . 0 
ANGAP  =  AP*C.RTD 

I F  ( ANGAP . L7 . 0 . 0  )  AN' GAP  =  ANGAP+  360  •  0 

UOU  =  UX*UX+UY*UY+UZ*U7 

UDV  =  UX*VX+UY*VY+UZ*V7 

RETURN 

FNO 


JK..V. 


*JRFTC  ST AT. 

SUBROUTINE  ST AT 
C 

C  THIS  SUBROUTINE  VEIEN  GIVEN  THE  LATITUDE  AND 

C  LONGITUDE  OF  A  STATION  COMMUTES  THE  FLF.MFNTS 

C  '  OF  COORDINATE  TRANSFORMATION  MATRIX 
C 

COMMON/AF IT/C (600) 

REAL  L AT ♦ L OMG .  L  AT  R  «  LONGR 

EQUIVALENCE  <0(126) .LAT  )  <  ( C  (  1  ?7  )  «LO?\’G  )« 

1 <C<047) «CLT13  ).(C(041)«CLTU  ) * ( C ( O') A ) . CLT 1 ?  ). 

?(CCOAR)  «CLT?3  )  ♦  (C(04?)  ,CLT?1  I  *  (C  (o*k  )  «  CLTS>?  )• 
3(C(0AP)  .CLT33  )  .  (  C  ( 04  3 )  « CLT3 1  )  .  (  C.  (  )  «  CLT??  )< 

DATA  CDTR/1  •74«=3?r>3E-?/ 

LATR=LAT*CDTR 
LONGR =LONG* CDTR 
SLONG=SlN( LONGR) 

CL  ON  G = CO  S  < !  O*  IGC* ) 

SLAT=SIN(LATR) 
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CLAT-COS  (LATE ) 

CL T  1  I  =— FLAT  l^CLO', G 

Cl  T?1  =-SLA7*SL  CNG 

CLT31 =  CLAT 

CLT1?=SL0NG 

CLT??=-CLONG 

CLT3?=0.0 

Cl  T1 Or- CL/- Tv-CLOMG 

C  L  T  2  3  =  CL  A  T  *•  S  L  ON'G 

CLT33=SLAT 

RE  TURN 

END 


►  .»  r.  j  y.  ~  v 


S.1HFTC  ME  AS* 

SUBROUTINE  ME  AS 
C 

C  THIS  SUBPOUT I KT  WHEN  GIVEN  THE  POSITION  AND 

C  AND  VELOCITY  COMPUTES  RANGE 4 RANGE  RATE »  AZ  1  MtJTH, 

C  AND  ELEVATION.  IT  ALSO  COMPUTES  THE  ELEMENTS 

C  OP  THE  MEASUREMENT  MATRIX*  '<*•.  THE  VAR  I  ArL^S  CO'>r,UTFD 

C  IN  ME AS  ARE  USED  IN  SUBROUTINE  KALIAN 

C 

COMMON/ AF  I T/C  (  600 1 


REAL  L AT, LONG 4 
FOU I VALENCE 

(C(091  >  «X 

« ( C ( 092  ) 

»Y 

)  4 

1 (C (003) (7 

)  «  (C.(09A>  *XD 

4 (C (095) 

4  YD 

)  1 

2 (C (096)470 

)  , (C( 1 37 j ,XS 

4 ( C ( 1 30 > 

»YS 

)  4 

3 ( C ( 1 39 ) • ZS 

)  « (0(006) * RHO 

4  (C(0G7> 

4  RHOPOT 

)  4 

A  (C  (013)  «'.T 

>4 (C(  14  1  )  ,XVS 

•  (Cf 142) 

4  Y  VS 

)  4 

5 ( C ( 1 A  3 ) « 7VS 

) 4 <C(241 ) ,M 

» (C< 126) 

4  L  AT 

)  4 

6(C ( 127) , LONG 

)  «  CC(041  )  4 CLT 1 1 

4 (C  C 044  ) 

4  CLT  1  2 

)  4 

7<C (0*7) «CLT1 3 

)  4  <C(042>  i Cl. ”7 1 

4  (C  (O'iS) 

4 CLT?? 

)  4 

n (C (OAfl) *CLT23 

) 4 (C(043>  *  CL  T  3 1 

4 (CCC46) 

4  CLT32 

)  4 

9(<\(0Ao>  ,CLT'J3 

)  4 ( C (OOP  )  *  AC 

i (C( 0^9  ) 

♦  r'C 

) 

DATA  CE»TR « CRTD/1  •  7453293E-? « S7*  293779/ 

LATR=LAT*CDTR 
LONGP=LOMG-CDTR 
slong=si  M( LONGR ) 

C  L  ONG  =  COS ( L  ONGP ) 

SLAT=SIN(LATP) 

CL A T= COS (LATR ) 

X  R  =  X + X  S 
YP-Y+YS 
7R-7+7S 

XVS-CLT1 l^MR+Cl  T?1 * YR4CL731*7R 
YVS  =  CLT1  ?*XQ+CLT2?*  YP+CLT37«ZR 
7VC=CLT1 3*XR4CLT?'1*YR+CLT33* ZR 

CAt.C'JLATf  Rm’Cj  «  RANGE  RATE «  AZIMUTH.  AND  ELEVATION* 


r>  o 
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RHn?  =  yr.>syD  *-YO£Y.p.»./r-5  7p 

PHO=por-T(PMO?) 

PHODOT  r-  CVR'XP  +  YDfYP  +  7  ^*70) /'‘‘'C 
AP-ATAN7  (  -YVStm  •. 

[P  =  AT  AN?  C  7  VC  «  rAPT  (  P!  :~P~7Y'?  7VC  5  ; 

ac=ar«cp i n 
F  r  =  rp> r pto 


CO- 'PUT '  T Hr  P'f ' A  «~uf  t  *'  t : 7 

c 

MCI  « 1  )  -x-.f/ayr. 

PCI  =  Y"'/LTO 
M  <  1  4  A)  r.VI  /T)MO 

Mc?*l>  =  (yr>) /“-•  io  -  •/  >/ 

«(?«?>  ■■  ( YD )  /PMC)  -  Pt-ory  ■-  r  Y('/‘ -ip;* 

M  (  J» «  7  )  -7H/TI  '.O-PHPPf  r  7.'  /  ■  !'"•? 

) -MCI  « 1  ) 

M  (  ?  4  C  > "M ( 1,?) 

MC?*6>=MC  1  «  7.  > 

T  1  =  1  •  0/  (  RH07? -7 VS*Z V  S  > 

M  C  7  4  1  >sTl*  <  ~XVS*  SI  CiviC- vv<,«  S'  AT  >  Cl  OPT, ) 
M  C  7  4  ?  )  =T  1  *  C  +>/\"'r  Cl  ONO-YV''-  "  C-L  AT  '  CI.OlvG  > 
M  C  7  4  7  >  =  T  1 *  C  YVr.-v  CL  AT  > 

T?=S0RTCT1 ) 

M  { A  4  1  )=T?S(CLAT*C(  ONG-7VA" XP/RNO? ) 
M(4»?)=T?«(  Cl  AT*SL0NG~7VV' YE/PH?:-  ) 

M  C4  4  7  > -~T?* C  Si AT  —7 V S * 7P/PH07 ) 

RETURN 

END 


*****-;' *>x 


! 

i 


/*!HFTC 


TRAJ* 

SUBROUT  1  KT 


TPAJI 


>.  r  >  > 


r  x  x  •: 


s  >'  x-  x  x  *  -x 


C 

C  THIS  SUP POUT IN”  Y.'wrN'  civ”  H  INITIAL  VALUES  POP  THP 

C  POSITION  AND  VPI-OC !  TY  INTEGRATES  THE  NON-LlNE/P 

C  STATE  EQUATION.  THE  INTEGRATION  OCCURS  BETWEEN 

C  MEASUREMENTS 

C 


COMMON/ A F I T/C C 600  ) 

DOUBLE  PRECISION  W 

D I  MENS  ION  O  <  6  4  S  >  4  W  C  6  4  5  >  4  Y  <  6  >  4  YP  C  A ) , X v  C  6  > 
EQUIVALENCE  C  C ( 007 ) «H  >4CCC001),X  )« 

ICC (091 >  4 Y  lilCllllliYO  ) 

OATA  M/6/ 

K  =  0 
K?=0 

DO  10  I - 1  4  M 

in  v;c  I  ♦n-n»LE<Yc  1 1 ) 

CALL  Pept 
DO  1  1=146 


GGC/EC/70-7 


*r 

* 


1  r>< !  »'o  =vr><  i  > 

PF  TIF-Vm 
rr>jTJ?Y  T p A j 
40  X^=X 

!  F  (*<•+."' .0)  IF  (K-P)  80490*110 
XP  =  XC 

no  49  I  —  1  •  * ’ 

ad  v  c  i  « f >  >  =  v  (  i  «  i  )  i 

90  K1=4~K 

DO  70  I*h«  ■  ; 

DO  60  J'-K  1*4 
60  D(  I  |j):  n.(|  4  J*  1  » 

V<  I  *3  )  =H*P<  1*4) 

*./(  i  *  l  )-o<  i « l  )  +  .r^n*‘.-(  i  «?> 

70  y ( I ) -f  ?;'L  (v:(  l « ;  >  > 
x~y  r+.'-^n 
CALI,  ofpt 

no.*  ?  I  =  i « 6 

2  0(1 *9) =YD( I ) 

DO  60  I  ~  1 4 M 

V(  I  #3)=H*D(  1*0) 

V<(  I  *  1  )  =  V.  (  1  «  1  J+.900*  <W<  I  4  3 )  —  V'/  (  I  4?)  ) 
ro  Y  (  I  )  -fV  'Cl.  (W ( l *  1  ) ) 

call  rr  pt 
DO  3  I '.-1*6 

3  0(1 *  9 ) r YD ( I  ) 

DO  90  I  -  1  * 

98  -08-4(9*9) 

V'  (  I  4 1  )  -V  (1*1)  +••'<  I  4  4  )  -•500KV  (1*3) 

90  Y(  1  )=?\’3t  (V'(  I  *  1  )  ) 

X=XC+H 
CALL  DFPT 
DO  4  1=1*6 

4  D  (  I  *  9  )  =  Y  D  (  1  ) 

00  100  I  =  1  *  M 

V-  (  !  *  1)  =  V/(  I  *  n  -V'<  I  4  4  )  +  •  1  6666666666666667*  ( W  (  I  «?)+?•  DO* 

1  (v/  (  1  4  3  )  (I*  4)) +*1-0(14  8)) 
ten  .  Y  (  I  )  sf  MOL  (V'(  I  *  1  )  ) 

K=K+1 
Cl  =K 

CALL  Of  PT 
00  F.  1  =  1*6 
r.  0(  I  *^)=YD(  I  ) 

RFTL9N 

11  0  DC  130  1-1*M 
v;  ( i  *?)  =w<  i  *  i  ) 

DO  130  J  = 1  *  4 

i?o  o  ( i  *  j)  =r»  ( i  *  j+  i ) 

V.'(  1  *3>='.;(  I  4?  )  +  .  4  1  66  066466666666-70- 1  *MS  (F8.*D(  I  #4)-59#* 
1 D ( ! * 0 ) +37 , *D ( *  «0)-  9.  •  P(  l *  1  >  ) 
i  ( i  *?)-'••  -*rx  1 4 1  > ) 

1 '0  Y  (  I  )-<•••,"  L  (••'(  I  4  n)  ) 
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x=xc+h 
CALL  HFRT 
DO  6  1=1*6 

6  D(l*r>)=YP(I) 

DO  1  ''i  0  1=1  *  M 

W  C  1  ♦  1  >=W< 1 «?  >  +  */*  1  6f  0006 6 Of  oor  6070- 1  " !  ( 1  *"D(  1  ♦Hi +  19 
1  D  (  !  ♦  4  )  -F>  .  •  !"■  (  1  , <  !  ♦  T  )  > 
l  *  3 )  i  n  (  i  *  r  n 

140  Y(  I)  -?N'61.('."(  1*1)1 
CALL  DFRT 
DO  7  1=1*6 

7  D  (  I  «  f‘  )  r  Yf )  (  1  ) 

OF TURN 

ron 


JinrTC  DFDT. 

SUHROUT I  Nf!  DFPT  PROVlfTf,  TUT  fV-R  I  VAT  I  Vf  1. !  5>T  DO'?  TH 
iNtrCHATlOM  ROOT  ILF  FOR  THF  T‘  JFCTORY  GFNFRAT I  ON* 


SU3R0UT I PF  DFRT 
COMMON'/ AF  I  T/C  ( 6C0  ) 
REAL  MU  *  J?  *  J  3 


EQUIVALENCE 

( C ( 09 1  )  ♦  X 

>  * ( C ( 097  > , Y 

)  ♦ 

1  (C (093)  *7 

) <  (  0 ( 094 )  *  VX 

)  *  (C(09F  )  *W 

)  « 

?(C(0O6)  *  V7 

)  *  (  C  <  0 1  9  )  ,  V.U 

>  *  (  C  (  0  1  3  )  *  '•!  1  E 

)  « 

3(C  (01  A  )  *V'IE? 

>  i  (  C.  (  n  1  >  *  VO 

)  «  (C(  11 P >  » YD 

)  • 

A (C  (  1  1  3)  *70 

),((;<  1  1  4  )  ,  VXD 

)i(C(l!5l* VYD 

)  t 

5<C(1 16)  ♦  V70 

> « (C( oio>  «Af-: 

)  ♦  (  r  (  o  1  7  >  ,  Jp 

)  t 

6 ( C ( 0 1 B )  *  J3 

)  *  (  C ( 097 )  ,  R 

) * (C(0°B)  ♦ v 

) 

RrT.ORT  (>C“X+Y 

“Yl  7  *7  ) 

V=SGRT  (  VX*  VX+VY*Vv+VZ«V7  ) 


COMPUTF  THF  HARMONIC  TERMS* 

A  =  MU/(Rif*3>) 

A  X  -  A  X 
AY=A*Y 
A7=A*7 
B  =  7/P 
BH=n*R 

Hr  (  J2-X  AF**2)  )/(R**2) 

F=  { J3* <A$**3)  )/(R“*3) 

H  A  =  1  •  ?  *  H  x  (  1  *  O  -  c  .  O  ”  r.  p.  H  7  .  R  y  r  r  (  3 , 0  -  7  ,  o  D  B  )  “  F  - 

Hp.r  1  *n*H*  (  3 •  0-0 •  0 * r.R )  42  •  *>*  F  *  (0.0-7.0*PP  )  •'  !3 

HA  =  MA+  1 .0 

HB  =  m+  1  .0 

XDr  VX 

YD  =  VY 

?D  =  V7 
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COiVf’UT  '  THF  f-OUATIGKS  OF  MOTION. 

VXO=— AX  ^ I IA+?  •  O :  U  1  f  * VY+XXW  jrp 
V  YD  =  ~  A  V  ••  H  A  -  2  •  n  !i  W  1  r-  r  vx  +  Y  r-  VV  1  F  2 
V7D::  — A7:  Hr> 

PFTUPN 

FNO 


ifftc  k<“  L' ■  * 

SU  FOOT  IMF  KALIAN 

THIS  SU-'POUT  I  N  V.'U~N  GIVEN  A  M  F  A  SU .?  rT  M  E  W  T  UPDATFS 
THF  F.PfvOr  COVAP1AVO  MATRIX  A  NO  COMPUTES  THE  LATFST 
0  PT  I  MUM  'T  T  1  M  A  i  F  S  O  ST  A  TF  L-  PROP  S 

COMM  ON/ AF  I  T/r  (  ft  00  > 

RFAL  K { 6 . A  > • KT  <  4 • A  >  «M( A « 6 >  *MT < ft * 4 1 

0  I  MFNS  I  OK  F*  (6,6)4 PH  I  (6*6)  4  PP  { 6*  6  )  « PF  (  6 «  6  )  ♦  R  ( 4  )  »  7  (  A  )  , 
OX  (6)  « DXFGT  (  6  )  ♦ 

1 P AO'-, ft (  ft  ♦  6  )  4  PH  1  T  (  ft  .  6  >  4 PAPftA ( ft ♦ A ) «  P A04 * < A ♦ 4 ) » A  <  1  0 ) « 
2PAD44 1  ( 4 ♦ 4 ) « P AMftftT (646)4 PAO66 1  (  ft  4  ft  ) 


FCUJ VALPNCF 

( C ( 27 1 ) 4  K 

) 4 (C<  24 1  )  • M 

)  4 

1  (C (007) 4  FT 

)  4  ( C ( 20  1  )  4  F 

) 4 (C(301  )  * PH I 

) , 

2(C  (4  01  )  4 PP 

)  4  (0(341)4  pfr 

) 4 ( C ( 230 ) 4  D 

)  4 

3 ( C ( 266  )  »  P 

) 4  ( C ( 296 )  4  7 

) 4 ( C ( 09 1 )  ,X 

)  4 

4 (C (301 ) , OX- ST 

)  4  (C(OGC)  iRHOC 

) 4 (0(0^7) iRHOOC 

)  » 

5  (  C  ( OSS  )  ••  AC 

) <  (C(061 )  4  PH DU 

)  i  (C(0"2)  4 RHODM 

)  4 

6(0(003) 4AM 

) 4 (C(0G«) 4^0 

)  4  (C(0£»4  ) 

) 

7 (C (Oftl  )  4 A700T  ) 

KAMFL  I  ST/KAVP  /i  /*/  ,  «*T  4^F  «  PP«  7  «  A  «<  «  I  FP 
OAT  A  COTR/1  .74  r'',2°3r-2/ 

UPOATF  M:  ASUPF'-TNT  MATRIX  -  M 

CAl  L  M F A S 

COMPUTE  FILTER  GAIK  VATR 1 X  -  K 

CA!  L  t/TRfi  (  "  .  MT  4  4  4  ft  4  0  ) 

CALL  MPPP  ( PF . MT  «  PA064  4ft»ft«0«0»4 ) 
CALL  MPf-T  (  M.PAP64  4f>A04/Mrt  «ft  «0«0  «4  ) 
DO  1?  1=1 »4 

1  ?  PAS  4  4  (  I  4  I  )  “PAD '.4  (  I  4  I  )  +R  (  I  > 

KX-  1 

DO  200  I  =  1  « 4 
DO  200  J= 1 4  I 
A  ( l'K  )  =  PAP4 4  (  J,  I  ) 

200  KX-KK+l 

CALL  SIKV  ( A  4 4 4  1  .OF-OG4  IFP) 

KK  -  1 
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DO  ?m  !  r  !  ,  '4 
DO  201  J— 1 • I 
>  P  AD*M  (J4  I  )=/■(*>•> 

PADA4  I  <  I  4 J>  =f5/.rv/,/4  I  (  J.  I  > 

201  KK^KP+l 

CALL  '••-l-’D  ( '•!  Dr.  A  *  '’/e/,  I  « 6  «  •'!  ♦  O «  O  «  A  > 

C 

C  UPDATE  PIL'f"*  pps-r'  j  {;'T  1  Of:  C~\"  R I  ANCF  "/  T*<IX 

C 

CALL  Mf'PD  (  <«P,r-Ar  O6464  A*0«0«r  ) 

DO  1  A  I ~  1  «  A 
DO  12  J=liA. 

1  2  PAOCC  (  I  «  J)  r  (  I  t  J  ) 

1  4  PAD60  (  I  •  II  -  1  .n  +  P;\<  C6  {  1  «  !  ) 

CALL  I'TRA  ( r-V,D66  .  '»AD66T  «75t^  i  0 ) 

C ALL  MPPD  ( P A^66 «rr  . p ADA>6 1  « 6 « 6 «  C ♦  O « 6  » 

C  ALL  f/,PPD  (  P  AD66 1  . <V  066 T  ♦  '*r>  ♦  6  ♦  A ,  n  «  O  «  6  > 

CALL  f'TPA  (K*:'vT,£,<tO) 

DO  MO  It- 1*6 
DO  MO  J=1M 

14  0  PAD 64 ( I  4 J)=K{  I • J ) *  P ( J > 

CALI  t'.PPD  <  P  AD64  «  <  T  « P  AP66  46444O4O46) 

DC  1  5  I“l«6 
DO  1  r5  J-W6 

15  PP(  I  .  j)-PP(  1  «  J)+PA066(  1  *J) 

CALCULATE  OI'TI’/'JV.  F.CT  I m  ATF  OF  ppi'OPf,  IN  STATES  L 

2(1)  =  RHCV-RHOC 
7(2)  =  RHODM-Rl-OD'" 

IF(  AC. LT. 0.0)00  TO  ICO 
GO  TO  300 

100  AC  =  AC  +  360.0 
300  IF(C(001  ).6T*  1.0)00  TO  50 

ACB  =  AC 
A  MB  .;=  AM 
50  ACA  =  AC 
AMA  =  AM 

CHECK  FOR  INCREASING  OR  DFCPFASIN'G  AZIMUTH 

IFCA2D0T)  1R.1T|17 
17  I F ( AMA- AMR ) 2  0  *  1  0  « 1 O 

20  A M*  =  AMA  +  360,  n 
10  ACAD  =  ACA  -  ACD 

IF (ACAB,LT.-35O.0« ACA  =  ACA+360,0 
GO  TO  30 

10  IF (AMA- AML) 21 .21 4 22 

2?  AMA  =  AMA  -  360.0 

21  ! F ( ACA-ACD) 20. 30  4^0 

40  ACA  =  AC A- 36 0.0  / 

30  Z ( 3 )  =  AMA-ACA  '  , 
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7(-  )  =  7  (  ■>  )  -COTH  Si 

Ar,--.;  r  A 
A‘-'»  =  A"/. 

7(4)  =  C 

7(4)  -  7(A)TCn~r 

c 

CALL  ('.  7.' <vr  *£  4  A  4  P-4  0-4  1  > 

r 

no  y>  1  =  1 

1  a  y  ( !  )  y  (  I  >•:!  y  '  O’  (  i  > 

n-rj 

r.»r> 


ML'  TC  SO:*. 

c.'j ’r’0:jT  1  ML  Frv/ 

C 

r  THir  ‘•'.r.f'O-jT IK"  v--*«-n  Givi:  thf  cur*P,rVT  values  o'- 

C  POSITION-  AVO  V^LCC  1TV  CO'^UTr  S  THf*  oyot  !•*'-' 

c  nrnrpjoTio*-'  »•*/,?*••>  iy  to  ?>.  usn>  in  lu^pout i np  upcov 


>  «  <  C  <  0 1 7 ) i Jp 
> 4 (C(On?)iY 
)  4  CC(?10)  4CV«? 

>  4  (C(21  1  )  irL'P 
)  4  CC<  PIP)  iP-62 

>  4  <C<PP3)  4T54 
)  4  ( C  ( 0  1  3  )  4  V'  I F 

C 

fO,-l!\iTr  TM~  HAPVOMC  TFFMn* 

A  =  K'J/ (  P  r  r  r  ) 

AX- A  i  X 

ay=a*y 

A.  7  -  Ar  7 
M  =  7/^ 

[iq-rif  p 

Mr  (  J?  r  (  AF-r  :■?  )  )  /(  s  p  > 

0  =  (  jor  (  AF”  -  ?  )  )/(P“  74  ) 
p  r  (  J7  r  (  /.!■  y  y  3  )  )  /( p  ■  5  3 )  . 

F  r  (  (  A  ^  y  r  3  )  )  /(  P*  >4  ) 

c-  =  l^.c^ry? 

CX  =  G'X 
C-Y  =  f:Y 
c.y*  -  C>y/l-'r-  3) 

C  Y>  -  "Y  /(■  ry>) 


tr C'.l  I  VALTs^T  {  r  i  0 1 0 )  4  VU 

1  (C(O)p)  4  jo  )  4  (C(Oon  «x 

P  ( C  (  0O? )  4  7  )  4  <r (P04  )  4c41 

?  (  C  (  P 1  o  )  4  F  '  )  4  (  c  (  ?(V3  )  4  1 

A  (C  (  P 1  7  )  4rr-">  )  4  (  r  <  POM  ,cr^j 

r>(C(Pir;  4f  6*1  ;  4  crfppr. )  4F/»£i 

6CC  <P!P)  4  Ar  )  4  (f  (01  *  > 
p-  cor  T  (  y  X  +  Y  v  Y-*-  7  7  ) 
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HA=1  (  1  •)  4  r  C1.C<- 7.0’- i 

Hf-  r  1  I  M  .O  '  ?>!’  >  (A.  O-^.O-  r  '  ISf, 


HA=!!A+i*0 
HR=HH+  !  .C 

HAX-P.o-r*:;*  n^.o'F  ■■ 

M  A  Y  =  3  •  ^  *  H  *  Y 

HAZ  =  6.''v:f  rz^  (3.0  i  - 
17.0“  ([':-••> -r.O  )  ) 


( 7.0 r  ) 

-1  .A  >  -I -v;.';,,  -v.r.r:-  -p.  A* 


;  -i  i ' 


(  A,  <••-  {  l  !  ,0/;> 


"  ) 


c 


co'-ruTr  to."  rr'-Tr  r-**f.rPiPT:ow  r./.Tf  ix  r# 

FA!=A-r  <  (p,rv-(  (''/•-»?  .a>  "HA-Y  ’’-i.'X  I  r'P 

F4?-tyzt  (3.0-  Y/(f-  i  2?)  ) 

f:  A  3  =  A'/“  (  (3.0-:  :’/  (  ^  :■  -> )  >  -?  MA-KA7  ) 

F'45-?.0-'V:IF 

P 5 1 "AY* ( (7.0”X/(PTrp) jchA-M/X) 

FF3?  =  A*  <  <  3. 0 *  <  (  Y/P  j  *  r  p )  -  *  . o )  :-KA- Y-:  Hr  Y  )  +V;  I  TP 
FG3-AY>v(  (3.0*2/(P>  *2)  )  >-HA  -HAZ  > 

F5A=-p.0r-WI£ 

HRX=X«  D*  (  30  •  0  X  PP-P  .  O  )  4-OXP*  (7.0ft  5P.-4  •  O  > 

HBY-  Y«DS  (  30 •  0  “ R-o .OUCYPi  (7. 0* -PP-4 •  O  ) 
Hn7-7«Y».0?0-  (--•.0  7n>-;-A.0)-H~.0^rr  (  j  .0-7#«?”P+7,0 

l (no**??)) 

F61  =A7f  (  (3.0'X/(Pr  XP)  )  SHri-HnY) 

F  6?  =  AZ*-(  (P.O-  Y/ (>'-'*  ?p  J  )*U'>->F*Y) 

F--63=A«(  (P.0*«n-1  «0  )  »H^-7vH77) 

PFtU'7N 

END 
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Append i>:  E 

Additional  figures  for  Groups  I  and  II  arc*  presented 
in  this  appendix.  Figures  58-74  are  fren  Group  I  results, 
and  Figures  75-98  arc  from  Group  II  results. 
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Fig.  72  Satellite  3823  Station  348  Pass  #8 
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